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Abstract 
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v>  <  ~  ' 

^  la  this  work,  we  analyze  the  motion  constraints  needed  to  maintain  direct  con¬ 
tact  between  two  rigid  bodies,  when  one  or  both  bodies  are  being  moved  under 
computer  control.  W6"first  stu<fy  the  time-based  instantaneous  contact  kinemat¬ 
ics,  then  develop;  a  control  formulation  and  specifications  within  the  AL  robot 
language  for  moving  so  as  to  maintain  the  desired  contact.  -Finally  we  study  the 
impact  which  results  when  bodies  are  moved  into  direct  contact.  These  studies 
on  robot  motion  with  direct  contact  between  bodies  are  useful  for  robot  motion 

planning  and  control. 

/  '  -  * ,  , 

WeTrave  studied  the  instantaneous  contact  kinematics,  under  planar  and  spatial 
motion,  of  a  moving  object  with  point  or  line  contact  between  surfaces.  In 
particular,  the  velocity,  acceleration  and  jerk  of  the  instantaneous  contact  point, 
and  the  constraints  on  the  angular  velocity  and  angular  acceleration  for  line 
contact  have  been  obtained  as  functions  of  surface  geometries  and  the  rigid  body 
motions  under  contact.  These  results  have  been  specialized  for  the  study  of  the 
special  motions  of  pure  rolling  and  pure  sliding,  and  for  the  contact  geometries 
where  contact  occurs  on  a  sharp  vertex,  a  sharp  edge  or  a  plane.  They  have  also 
been  used  to  study  bodies  moving  with  multiple  contacts,  f  * 

Body  trajectories  to  maintain  the  contact  can  be  preplanned  using  the  equations 
developed  in  this  thesis.  In  addition  these  results  can  be  used  in  real  time  control 
in  conjunction  with  tactile  sensing.  The  equations  for  the  trajectory  of  an  instan¬ 
taneous  contact  point  are  useful  in  position  and  force  control.  We  have  shown 
that  ihe  availability  of  a  proper  force  sensor  can  replace  the  need  for  knowledge  of 
the  contact  surfaces’  geometry  in  determining  the  normal  acceleration  at  contact. 

As  an  implementation  cf  the  instantaneous  contact  kinematics,  we  have  formu¬ 
lated  a  controller  to  maintain  the  direct  contact  motion,  and  extended  the  AL 
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robot  language  tc  facilitate  direct  contact  motion  specification.  The  control  can 
be  formulated  directly  in  contact-task  variables,  and  include  the  inertia  force  cor¬ 
responding  to  acceleration  along  the  contact  normal.  The  language  extensions 
allow  for  the  specification  of  contact  surface  geometry,  contact  trajectories,  and 
the  motion  parameters  such  as  error  tolerance  and  directional  wobble. 

Concerning  the  instant  of  making  contact,  we  have  studied  the  sensitivity  of  the 
impact  impulse  to  the  link-mass  distribution  of  a  revolute-jointed  planar  ma¬ 
nipulator.  In  this  connection,  link-space  representations,  optimal  pivot  location, 
influence  of  the  mass  and  orientation  of  each  link  on  the  impact  impulse  at  the 
end-effector  have  been  considered. 
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Chapter  1 


INTRODUCTION 


1.1  Contact  between  surfaces 
System  and  assumptions 

Industrial  robots  operating  under  computer  control  are  often  required  to  move 
so  as  to  make  and  maintain  contact  between  bodies  which  are,  except  for  this 
contact,  capable  of  completely  independent  relative  motions.  Examples  of  single 
and  multiple  contacts  are  found  in  the  use  of  industrial  robots  for  grinding, 
polishing,  cleaning,  parts  sliding,  peg  insertion,  and  object  re-positioning  within 
a  dextrous  hand.  Motion  with  direct  contact  sometimes  provides  a  way  to  reach 
a  goal  position,  sometimes  it  is  the  task  itself.  In  this  work  we  study  the  motion 
of  a  manipulator  (or  a  finger)  with  direct  contact  between  rigid  surfaces. 

From  a  kinematic  point  of  view  the  direct  contact  temporarily  forms  a  higher 
kinematic  pair  between  the  contacting  bodies.  One  body  can  be  the  end-effector 
or  one  link  of  a  manipulator,  and  the  other  body  can  be  a  work-piece  or  the 
environmental  support.  A  grasped  object  and  a  contacting  link  of  a  finger  of 
a  robot  hand  also  form  such  a  kinematic  pair.  Although  both  bodies  being  in 
motion  could  be  considered  as  the  general  case,  the  essence  of  the  kinematics  is 
in  the  relative  motion  between  the  contacting  bodies.  Therefore,  we  can,  for  the 
most  part,  assume  only  one  body  is  moving  and  that  its  motion  is  its  relative 
motion  with  respect  to  the  other  body.  We  will  therefore  refer  to  the  bodies  of 
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contact  as,  respectively,  the  moving  and  the  fixed  bodies,  and  label  the  contacting 
moving  surface  as  m  and  the  contacting  fixed  surface  as  /. 

The  actual  contact  characteristics  depend  heavily  on  the  elasticity  of  the  surface 
materials.  We  limit  ourselves  to  the  study  of  rigid  body  motions,  and  assume 
both  contact  surfaces  are  rigid.  In  many  applications  the  elastic  deformation  of 
the  contacting  surfaces  is  negligible.  An  artificial  surface  which  is  constructed 
mathematically  to  facilitate  manipulation  tasks  such  as  arc  welding,  painting, 
etc.,  can  also  be  considered  as  a  rigid  surface  in  our  study.  When  two  rigid 
surfaces  are  in  relative  motion,  in  practice  there  are  three  possibilities  of  practical 
interest:  point  contact,  line  contact,  and  planar  contact. 

For  the  most  part,  in  this  work,  we  also  assunrie  that  the  geometries  of  both 
surfaces  are  given  at  the  contact.  This  is  the  case  when  a  robot  is  in  contact 
with  an  object  of  simple  geometry,  such  as  a  sphere,  a  plane,  a  circular  cylinder, 
or  when  complete  geometric  models  of  the  contacting  surfaces  exist.  Later  on 
we  will  show  that  this  restriction  can  be  relaxed,  in  calculating  a  contact  points 
acceleration,  if  there  exist  force  sensors  which  can  determine  the  position  of  the 
contact  point  or  contact  line. 


Figure  1.1  Instantaneous  trajectories  defined  at  a  point  contact 


Motion  compatibility  for  maintaining  contact 

In  studying  the  instantaneous  kinematics  of  direct  contact,  it  is  useful  to  distin- 
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guish  between  the  several  associated  trajectories.  For  rigid  body  motion  with 
point  contact  we  label  the  point  of  contact  as  P,  and  distinguish  between  the 
point  on  the  fixed  body  Pf  and  point  on  the  moving  body  P,n.  We  refer  to  the 
trajectory  of  Pm  as  the  moving  point  trajectory  (Fig.  1.1.).  For  rigid  body 
motion  with  line  contact  it  will  also  be  useful  to  define  a  moving  point  trajectory; 
this  will  be  done  by  relocating  Pm  as  one  of  the  points  on  the  contact  line  fixed 
in  the  moving  body. 

It  is  a  well  known  result  that  the  basic  kinematic  constraint  of  the  direct  contact 
is  that  the  velocity  of  the  contact  point  must  be  zero  in  the  direction  of  the 
common  normal  of  the  contacting  surfaces.  If  this  condition  is  violated  the  direct 
contact  constraint  is  broken.  In  this  thesis  we  are  also  interested  in  higher  order 
instantaneous  restrictions  on  the  the  moving  point's  trajectory.  For  example, 
we  know  that  the  normal  acceleration  for  a  particle  moving  with  velocity  V 
on  a  circle  of  radius  R  is  V2/R,  and  that  this  information  gives  the  second 
order  motion  compatibility  for  keeping  the  particle  in  circular  orbit.  We  need  to 
know  the  analogous  relationships  when  direct  contact  occurs  between  two  smooth 
curves  or  two  smooth  surfaces. 

Motion  planning  and  sensing  for  contact 

We  have  referred  to  the  trajectory  of  Pm  as  the  moving  point  trajectory:  this  is 
the  trajectory  of  an  actual  point.  We  now  introduce  two  other  trajectories  that 
will  be  of  equal  importance,  but  do  not  represent  the  motion  of  any  single  physical 
point.  For  rigid  body  motion  with  point  contact,  we  imagine  a  pair  of  points, 
Qm  and  Qf,  which  do  not  belong  to  either  body  and  move  along  the  moving 
and  fixed  surfaces,  respectively,  so  that  they  are  always  at  the  instantaneous 
contact  point.  We  call  the  trajectories  generated  by  these  points  the  moving  and 
fixed  contact  trajectories,  respectively  (Fig.  1.1).  Their  first  and  second 
order  time  derivatives  are  called  the  moving  and  fixed  contact  velocities  and 
contact  accelerations,  respectively.  For  rigid  body  motion  with  line  contact, 
the  trajectories  of  the  contact  lines  with  respect  to  each  surface  are  of  importance, 
these  trajectories  are  ruled  surfaces.  However,  a  line  trajectory  can  be  partitioned 
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into  a  point  trajectory  tracing  a  reference  curve  on  the  ruled  surface,  and  a 
spherical  image  curve*  tracing  the  direction  of  each  ruling  in  contact.  We  will 
see  that  the  line  contact  trajectories  can  be  studied  as  point  trajectories,  these 
capture  enough  motion  information  since  the  line's  orientation  can  be  determined 
from  the  geometries  of  the  contacting  surface. 

We  are  interested  in  the  instantaneous  relationships  between  the  contact  tra¬ 
jectories  and  the  motion  of  the  moving  body  since  such  relationships  are  useful 
in  trajectory  planning.  The  contact  relationships  can  help  us  to  determine  the 
required  motion  of  the  moving  body.  On  the  other  hand,  these  relationships  are 
also  useful  in  the  calculation  of  the  actual  motion  of  the  moving  body:  with  a 
force  sensor  we  can  measure  the  contact  positions,  velocities,  etc.  on  one  sur¬ 
face,  and  use  this  information  in  the  instantaneous  kinematics  relationships  to 
calculate  contact  trajectories. 

Force  is  sensed  using  either  remote  force  sensors  or  direct  tactile  sensors.  Remote 
force  sensors,  such  as  a  force  wrist,  a  spherical  force  cell  on  a  finger  [Brock  and 
Chiu,  ’85],  or  pair  of  force  cells  on  a  gripper,  can  sense  a  force  wrench  at  the 
contact,  and  determine  the  contact  point  of  the  force.  When  the  inertial  forces 
between  the  contact  point  and  sensor  are  not  negligible,  we  can  compensate 
for  them  if  we  have  two  force  sensors  in  cascade  (a  force  wrist  and  a  gripper 
with  force  cells),  and  know  precisely  the  inertia  parameters  between  the  two 
sensors.  A  direct  tactile  sensor  consists  of  an  array  of  deformation  or  force 
sensing  elements.  Since  there  is  usually  an  elastic  skin  cover  on  a  tactile  sensor, 
many  of  its  elements  will  be  afTected  when  there  is  a  single  point  contact.  By 
signal  analysis,  contact  position  can  be  estimated.  Taking  time  derivatives  to  the 
contact  position  obtained  from  either  a  remote  force  sensor  or  a  tactile  sensor, 
we  can  calculate  the  contact  velocity,  or  even  the  contact  acceleration  although 
the  latter  will  be  very  noisy.  In  the  following  we  use  the  term  tactile  sensor  to 

*  A  spherical  image  curve,  also  known  as  the  Gaussian  image,  is  a  spherical  curve 
on  which  each  point  represents  a  unit  vector  parallel  to  the  direction  of  a  spatial 
line  corresponding  to  a  given  time  [Bottema  and  Roth,  ’79]. 
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refer  to  either  a  force  sensor  (or  a  combination  of  force  sensors)  or  a  tactile  sensor 
which  can  sense  the  contact  position. 

Control  formulation  and  language  specification  for  contact 

The  instantaneous  relationships  we  develop  for  calculating  the  moving  point’s 
trajectory  can  be  used  for  the  trajectory  control  of  direct  contact  motions.  For 
a  robot  under  both  position  and  force  control,  the  methods  developed  in  this 
thesis  allow  for  the  use  of  the  acceleration  or  even  the  jerk  of  the  moving  point’s 
path,  and  this  should  improve  the  smoothness  of  contact.  We  present  one  such 
control  formulation  directly  in  terms  of  the  contact  variables. 

Considering  robot  motion,  there  is  a  need  for  the  development  of  robot  language 
capabilities  for  contact  specifications.  Particularly,  we  need  to  determine  how 
to  describe  a  direct  contact  with  sufficient  generality,  and  at  the  same  time 
with  simplicity  and  efficiency.  In  this  regard  we  present  an  extension  of  the  AL 
robot  language,  which  specifically  adds  to  the  language  high  level,  direct  contact 
programming  capabilities. 

Impact  impulse  reduction  in  making  contact 

Most  of  this  thesis  focuses  on  maintaining  a  contact.  Another  problem  deals  with 
how  to  reduce  the  impact  impulse  which  usually  occurs  in  first  making  contact,  fn 
most  robot  operations,  it  is  desired  that  the  initial  contact  be  as  soft  as  possible. 
Even  for  a  task  like  hammering  a  nail  into  a  board,  we  don’t  want  the  impulse 
to  be  felt  by  the  hand;  the  hammer’s  center  of  percussion  or  a  nearby  point 
will  be  used.  We  therefore  investigate  how  to  design  parallel  revolute-jointed 
manipulators  or  plan  their  postures  to  reduce  such  impact  impulses  under  a 
given  approach  velocity. 

1.2  Relevant  literature 

There  have  been  many  studies  on  contact  kinematics.  From  classic  kinematics 
theory,  it  is  well  known  that  general  planar  motion  can  be  represented  by  two 
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centrodes  rolling  on  each  other,  and  that  general  spatial  motion  can  be  repre¬ 
sented  by  two  axodes  raccording  with  each  other  (for  example,  see  (Bottema  and 
Roth,  ’79]).  However,  except  for  planar  pure  rolling,  there  are  no  previous  de¬ 
tailed  derivations  on  the  general  higher  order  instantaneous  kinematics  of  direct 
contact.  There  have  been  many  studies  of  gear  contact,  these  address  issues  of 
both  line  and  point  contact  between  two  surfaces,  but  the  relative  motions  con¬ 
sidered  there  are  usually  of  special  types  (under  the  constraints  of  gear  axes), 
and  the  emphasis  is  on  gear  analysis  and  design.  In  robotics  some  researchers 
have  considered  motions  constrained  to  maintain  a  single  point  contact  on  a  sur¬ 
face  [Vukobratovic  and  Potkonjak,  ’85],  and  first  order  pure  rolling  in  grasping 
[Kerr,  1984;  Cutkosky,  1985;  Ji,  1987].  In  terms  of  combined  rolling  and  sliding, 
and  motion  relationships  in  connection  with  surface  curvature,  however,  the  only 
study  we  know  of  that  approximately  parallels  ours,  is  Montana’s  recent  thesis 
[Montana,  ’86],  He  derived  the  first  order  relationships  between  the  contact  ve¬ 
locities,  the  sliding  velocity  and  the  angular  velocity  of  the  moving  body.  We 
used  a  different  approach  to  independently  derive  essentially  the  same  first  order 
results  at  approximately  the  same  time  [Cai  and  Roth,  ’86,  ’87],  In  addition  we 
derive  the  kinematics  of  second  and  higher  order  contact  constraints,  these  topics 
are  completely  new. 

Hybrid  position  and  force  control  schemes  have  been  extensively  developed.  Ma¬ 
son  [Mason,  81]  proposed  the  Configuration  space,  Raibert  and  Craig  [Raibert 
and  Craig,  ’81]  provided  an  implementation  of  the  hybrid  position  and  force 
control  formulation.  The  hybrid  position  and  force  control  scheme  was  then  gen¬ 
eralized  to  an  arbitrary  frame,  [West  and  Asada,  ’85;  Lipkin  and  Duffy,  ’86],  A 
dynamics  model  based  control  formulation  on  operational  space  has  been  devel¬ 
oped  by  [Khatib,  ’80;  Khatib  and  Burdick,  ’86].  We  use  these  results  to  show 
that  the  acceleration  of  the  moving  point  at  the  contact  is  important  to  force 
control.  Since  joint  torques  change  non-lintarly  with  the  motor’s  control  voltages 
or  currents,  which  unfortunately  are  usually  the  lowest  level  input  commands, 
some  researchers  have  included  third  order  motion  derivatives  into  control  formu¬ 
lations  [Goor,  ’85].  These  provide  the  motivation  for  the  development  of  third 
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order  properties  in  this  thesis.  The  development  of  AL  was  due  to  Goldman 
[Goldman,  ’82],  His  work  is  the  point  of  departure  for  our  extension. 

Finally,  as  related  to  our  study  on  impart  impulse,  the  previous  works  are  mainly 
restricted  to  motion  or  simulation  analyses  [Vukobratovic  and  Potkonjak,  ’85; 
Wang  and  Mason, ’87]  and  control  strategies  for  dealing  with  the  effects  of  impact 
[Khatib  and  Burdick,  ’86],  The  virtual  mass  [Asada  and  Ogawa,  ’87]  is  a  useful 
concept  particularly  relevant  to  our  study. 

1.3  Preview 

Chapter  2  through  Chapter  4  are  dedicated  to  the  development  of  the  instanta¬ 
neous  contact  kinematics.  Besides  point  contact  between  planar  curves,  we  study 
point  contact  between  two  surfaces  and  line  contact  between  two  ruled  surfaces. 

In  Chapter  2  we  study  the  so-called  planar  roll-slide  motions  between  curves 
with  point  contact.  The  velocity,  acceleration  and  jerk  of  the  moving  point,  and 
the  contact  velocity  and  contact  acceleration  have  been  expressed  as  functions 
of  curve  curvatures  and  motion  variables.  The  special  geometries  where  either 
the  moving  or  the  fixed  curve  is  a  point  or  a  line  are  treated.  Finally,  planar 
motion  planning  and  sensing  for  moving  bodies  with  multiple  point  contacts  has 
also  been  treated. 

In  Chapter  3  we  study  spatial  roll-slide  motions  between  two  surfaces  with  point 
contact,  and  derive  the  instantaneous  relationships  for  the  contact  trajectories 
and  moving  point’s  trajectory.  The  special  geometries  when  either  surface  is  a 
point,  a  line  or  a  plane  are  treated.  Spatial  motion  planning  and  sensing  for 
moving  bodies  under  single  and  multiple  point  contacts  have  also  been  treated. 

In  Chapter  4  we  study  spatial  roll-slide  motions  between  two  developable  ruled 
surfaces  with  line  contact.  Besides  the  moving  point’s  trajectory  and  the  contact 
trajectories,  we  also  consider  the  constraints  on  the  moving  body’s  angular  veloc¬ 
ity  and  angular  acceleration  for  maintaining  line  contact.  The  special  geometries 
where  either  surface  is  a  line  or  a  plane  are  treated.  Spatial  motion  planning  and 
sensing  for  moving  bodies  under  multiple  line  contacts  have  been  treated. 
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The  moving  point’s  higher  order  properties  can  be  useful  for  the  position  and 
force  control  of  a  manipulator;  the  moving  contact  point  can  be  either  on  the 
end-effecto.  or  on  any  other  link.  In  Chapter  5,  we  consider  the  case  where  the 
contact  point  varies  with  respect  to  the  moving  surface  and  modify  the  “op¬ 
erational  space  control  ”  formulation.  This  study  addresses  the  choice  of  task 
variables  for  contact,  expressing  the  control  law  directly  in  terms  of  task  variables, 
designing  motion  compatibility  filters,  and  calculating  parameters  of  dynamics 
model  for  the  task  space  from  those  for  a  reference  system.  We  have  shown  that 
given  the  moving  surface’s  geometry,  and  a  force  sensor  which  can  determine  the 
moving  contact  velocity,  we  can  measure  the  moving  point’s  acceleration  along 
the  contact  normal,  and  hence  compensate  for  the  corresponding  inertia  force  of 
the  moving  body.  We  have  also  derived  the  number  of  unknowns  associated  with 
force  sensing  and  static  force  manipulability. 


As  a  counterpart  to  the  control  formulation  for  contact,  Chapter  6  describes  the 
new  specifications  for  the  AL  robot  language.  This  chapter  discusses  the  specifi¬ 
cations  of  a  moving  object’s  geometry,  and  a  Cartesian  trajectory.  The  kinematic 
and  force  conditions  for  calculating  task  frames,  and  motion  constraints  with  re¬ 
spect  to  the  task  frames  are  treated. 


As  an  initial  study  to  consider  the  reduction  of  impact  impulse,  in  Chapter  7 
we  study  the  impulse’s  sensitivity  to  link-mass  distribution  for  revolute-jointed 
planar  manipulators.  Based  on  a  link-space  coordinate  representation,  we  analyze 
how  to  reduce  the  impact  impulse  by  optimum  pivot  location  and  choice  of  mass 
proportions.  The  influences  of  the  number  of  links  on  the  impact  response,  and 
the  reaction  impulse  at  the  joints,  are  also  developed.  These  results  are  useful 
for  designing  parallel  revolutc-joint  manipulators  which  are  exposed  to  impact 
loads  and  for  planning  their  trajectories. 


Chapter  8  gives  a  summary  and  indicates  areas  of  possible  further  work  along 
these  lines. 
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PLANAR  MOTION  WITH 
POINT  CONTACT 


moving  contact 
trajectory 


/ 

fixed  contact  trajectory 

Figure  2.1  Arbitrary  position  of  a  moving  curve  in  point  contact 

For  planar  motion  of  a  rigid  body,  the  direct  contact  can  often  be  modeled  as 
point  contact  between  two  curves,  as  shown  in  Fig.  2.1.  Here,  the  moving  point 
Pm  is  a  contact  point  on  the  moving  curve,  and  the  fixed  point  Pf  is  a  contact 
point  on  the  fixed  curve.  The  fictitious  points  Qm  and  Qj  move  along  the  moving 
and  fixed  contact  curves  sc  as  to  always  be  at  the  contact  point.  We  define  P 'm 
as  a  new  contact  point  on  the  moving  body  corresponding  to  a  given  $.  P ^  will 
be  coincident  with  Pm  as  $  approaches  zero. 

In  the  following,  we  collect  several  important  results  from  classic  kinematics. 
Based  on  these  we  consider  the  contact  constraints,  and  obtain  the  basic  kine¬ 
matic  relationships  for  contact  trajectories  and  moving  point  trajectories.  We 
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then  consider  how  to  preplan  the  motion  variables  involved  in  these  relationships, 
and  extend  the  relationships  for  single  point  contact  to  cases  where  there  exist 
simultaneous  multiple  point  contacts. 

2.1  Several  results  from  classical  kinematics 

The  velocity  of  P "m  as  measured  in  a  fixed  frame,  Vm,  is  in  general  not  zero. 
We  call  Vm  the  sliding  velocity  at  the  contact  or  simply  the  sliding  velocity. 
The  moving  body  also  has  some  rotation,  and  because  of  this  its  motion  is  often 
referred  to  in  German  as  a  “Rollgleit”,  i.e.,  roll-slide.  We  will  refer  to  roll- 
slide  motions  as  general  motions  since  neither  pure  sliding  or  pure  rolling  occurs 
relative  to  the  contact.  These  latter  two  special  motions  are  also  interesting: 
pure  sliding,  in  which  every  point  in  the  moving  body  has  velocity  Vm,  and  pure 
rolling,  in  which  the  moving  curve  is  rolling  on  the  fixed  curve.  Under  pure 
rolling,  the  contact  curves  are  the  moving  and  fixed  centrodes,  respectively.  In 
each  such  position  the  contact  point  is  obviously  the  instantaneous  center  of 
rotation. 

It  is  well  known  that  the  velocity  of  Qm  and  Q j,  with  respect  to  a  fixed  frame, 
are  equal,  i.e., 

V*m  =  VQr  0-1) 

Let  us  define  the  velocity  difference  or  the  so-called  relative  velocity  of  to 
Pm,  VQ/p>.  From  this  one  of  the  basic  relations  used  in  the  study  of  the  direct 
contact  follows: 

VQf  ~  VQm  =  VP  +  VQ/P'-  (1-2) 

The  other  important  property  that  is  well  known  deals  with  the  curvatures  of 
the  contacting  curves:  the  centers  of  curvatures  for  the  contacting  curves  are 
conjugate  points,  i.e.,  at  the  instant  of  contact,  the  trajectory  of  the  moving 
point  which  is  the  center  of  curvature  of  the  moving  curve,  Cm,  has  the  same 
center  of  curvature  as  the  fixed  curve,  Cj  (see  Fig.  2.2).  Most  important  is  the 
fact  that  the  instantaneous  radii  of  curvature,  pm  and  pj,  of  the  curves  satisfy 


m 

I 

R 


Wi 

§ 

& 


the  general  Eulcr-Savary  equation,  which  has  the  form 


(— - -)sinfl  =  —t  (13) 

Pm  Pf 

where  6  is  the  ray  angle  and  b2  the  second  order  instantaneous  invariant  -  see  p. 
278  of  [Bottema  and  Roth,  ’79] .  The  ratio  Vq/p/Vq,  is  a  scalar  called  the  roll- 
slide  number,  this  number  is  known  to  be  a  projective  invariant  [Muller, ’63],  since 
it  equals  the  cross  ratio  of  the  points  (/,  P,  Cf,  Cm),  where  I  is  the  instantaneous 
center  of  rotation. 

Equations  (1.1),  (1.2)  and  (1.3)  embody  the  known  results  which  are  relevant  to 
our  study,  it  is  from  these  that  we  take  our  point  of  departure. 

2.2  Constraints  on  point  contact  between  curves 


j  y/. 
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V  F/,Q;  ■/ 


z/.1. 


Figure  2.2  Initial  position  of  a  moving  curve  in  point  contact 

Motion  constraints  for  maintaining  point  contact  are  due  to  restrictions  on  the 
contact  normal,  contact  trajectories,  and  the  moving  point  trajectory. 

Consider  an  instantaneous  contact  at  points  Pm  and  Pj  as  shown  in  Fig.  2.2. 
We  call  this  configuration  the  reference  or  zero  position,  and  use  Pm  and  Pf  as 
the  origins  for  fixed  and  moving  coordinate  systems.  In  the  reference,  or  zero 
position,  Pm  and  Pf  are  coincident;  the  x  axes,  xm  and  x  ,  are  along  the  common 
tangent  to  the  two  curves;  the  y  axes,  ym  and  yf ,  are  along  the  common  normals 
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and  point  in  toward  the  moving  curve  (Fig.  2.2).  As  the  motion  proceeds  the 
moving  body  rotates  by  an  angle  $  (counter  clockwise  sense  is  positive)  and  the 
geometry  is  as  shown  in  Fig  2.1. 


The  moving  curve  with  respect  to  the  moving  frame  is  represented  by 


V  m  ^m(^m)' 


The  fixed  curve  is  represented  by, 


y,  =  ~  M*,)- 


By  definition,  at  the  reference  or  zero  position, 


=  =  0,  hm  =  h,  =  0,  hm  l  -  hJA  -  0. 


We  have  adopted  the  following  convention,  —  d}hm/dx}m  and  hf  j  =  d3hf  / 


Constraints  on  the  curve  normal  at  contact 


The  slopes  of  the  tangents  to  the  curves  are  given  by  hm  ,  and  hf  ,  respectively. 
Thus,  using  a  column  matrix  form,  at  every  point  on  the  moving  curve  the  inward 
pointing  unit  normal  is 


= 


2 _  (~hmA\ 

i  )' 


*  We  have  assumed  the  explicit  forms  of  the  equations  of  the  moving  and  fixed 
curves.  If,  instead  we  used  the  implicit  forms  g{x,y)  =  0,  then  we  would  have 
on  analogous  development  but  instead  of  (Al)  in  Appendix  A  we  would  use 


i  _  9x9yy  9y9xx 

(9l+9l)t 


and  all  the  other  results  would  follow.  Here  the  subscripts  denote  derivatives 
with  respect  to  the  subscripted  variables. 
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and  at  every  point  on  the  fixed  curve  the  outward  pointing  unit  normal  is 


Taking  t  to  be  a  time  variable,  we  can  consider  xm(t)  as  the  x  coordinate  of  a 
point,  Qm,  which  generates  the  curve  hm(t )  and  moves  at  such  a  rate  that  the 
point  is  always  at  the  contact.  For  this  curve  N^l)  corresponds  to  the  inward 
pointing  normal.  Similarly,  we  can  consider  the  coordinate  xf  of  Qf  as  a  function 
of  time,  and  the  function  N f(t)  gives  the  outward  pointing  normals  of  the  fixed 
curve.  At  each  instant  the  inward  pointing  normal  of  the  moving  curve  and  the 
outward  pointing  normal  of  the  fixed  curve,  at  the  current  point  of  contact,  must 
coincide.  This  property  holds  true  for  any  motion  regardless  of  the  amount  of 
rotation  and  sliding,  so  long  as  the  contact  is  not  broken.  Thus  we  require  that 

Nj(t)  =  R(t)  Nm(t),  (2.6) 

where  R(t)  is  the  2x2  matrix  which  transforms  the  coordinates  of  the  moving 
system  to  their  values  in  the  fixed  system.  Using  the  rotation  angle  <I>  in  Fig. 
2.1, 

o/,v_  (cos*(t)  -sin<f >(*)\  ,?7) 

R()~[sin  *(<)  cos  $(<)  )  {27) 

Since  (6)  is  valid  for  entire  motion  trajectory,  its  nth  order  time  derivatives  can 

be  written  as 

£  =  £(*«)  *-«>]•  <2«> 

If  we  define  ui  =  d$/dt  and  £  =  c pty/dt7 ,  and  substitute  from  Appendix  A  (A2) 
and  (A3)  into  the  first  two  derivatives  of  (8),  their  first  rows  yield  in  the  initial 
position 

kmxm  +  kjif  =  -ui,  (2.9) 

k'mi2m  + k'}x7f  +  kmxm  +  kfxf  = -t.  (2.10) 


The  second  two  rows  of  (8)  are  not  independent,  since  we  have  the  constraints 
Nm{t)T  N  n(t)  =  1  and  Nf(t)T  N /(<)  =  1.  (The  superscript  T  denotes  the 
transpose.) 
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Figure  2.3  Contact  trajectories 

Constraints  on  contact  trajectories 

The  position  vector  for  Qf  with  respect  to  the  fixed  frame  (see  Fig  2.1)  can  be 
represented  by 

=  (;;).  (2.1) 

If  we  define  the  position  vector  for  Pm,  with  respect  to  the  fixed  frame  as  J°/m, 
then  the  position  vector  for  Qm,  with  respect  to  the  fixed  frame,  can  be  repre¬ 
sented  by 

rQm  =  Pjm  +  RXm,  (2.12) 


where  Xm  a  position  vector  for  Qm  with  respect  to  the  moving  frame. 


=  (»:) 


(2.13) 


Considering  xm  and  x  as  parameters  tracing  the  locus  of  the  contact  points, 
equations  (11)  and  (12)  are  expressions  for  the  same  trajectory  (as  viewed  from 
the  fixed  space  -  Fig.  2.3).  Equating  them  yields 


Xf  —  P}tn  +  RXm. 


(2.14) 


Taking  the  first-order  time  derivative  of  (14)  and  making  use  of  (1.1)  yields 


VQ,  =  VQm  =  Am  =  (Pfm  +  RXm )  +  (RXm). 


(2.15) 


w; 


B 


r^jvvvv'v',^ 
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Comparing  this  with  (1.2)  we  have  Pym  +  RXm  =  Vy  and  /LYm  =  Vq/P'.  For 
simplicity  we  drop  the  subscript  P'  from  the  sliding  velocity  and  denote  it  simply 
as  V .  The  first  parenthesis  in  (15)  is  the  general  expression  for  the  sliding  velocity 
at  every  point  of  the  fixed  curve.  Taking  higher  derivatives  of  V  (i.e.  Vp)  yields 


where 


— (P}m  +  RXm)  =  V<"\ 


(2-16) 


(2.17) 


We  have  used  the  notation,  dnvx/dtn  =  and  dnvy/dtn  =  v^n\  V  is  the  rate 
of  change  of  the  sliding  velocity,  it  depends  on  both  the  change  in  sliding  speed 
and  change  in  sliding  vector  orientation,  we  call  it  the  sliding  acceleration. 
Null  sliding  acceleration  corresponds  exactly  to  the  condition  for  second  order 
pure  rolling  of  the  contacting  curves,  provided  of  course  we  have  null  sliding 
velocity.  In  other  words  for  null  sliding  velocity  and  acceleration,  the  contacting 
curves  are,  to  second  order,  identical  with  the  centrodes  of  the  motion.  Similar 
statements  are  true  for  the  higher  order  terms,  that  is,  for  pure  rolling  up  to  the 
ntk  order,  V  =  V  =  V*"-15  =  0.  We  will  refer  to  this  in  (4  8). 

We  take  the  first  three  derivatives  of  (14)  at  the  initial  position  and  use  (16), 
(A2)  and  (A3),  the  first  row  of  each  derivative  can  be  written  as: 


X  j  —  Vx  “H  m , 


'  j  —  Vx  4“  3?  rn , 


x\3)  =  vx  +  x{^>  -  xmu7  -  2kmx7rnu)] 


the  second  rows  yield 


Vy  =  0, 

vy  =  - k,x 2  -  -  kmx2m , 


- k'fi *  -  3 kjxfxt  -  2xmu  -  imc  -  h'mxsm  -  3kmxmxr 


(2.18) 


(2.19) 

(2.20) 


(2.21) 

(2.22) 

(2.23) 


■  V'  V  V'  N*  pi 

/v*  ’j1  v  (\y  ' 


• 

•>v' 


Constraints  on  the  moving  point 

Let  the  position  vector  for  the  moving  point 


Substituting  n  =  0,  1  and  2  into  (16),  and  using  (A2)  and  (A3),  the  first  rows  of 
the  resulting  matrix  equations  yield 


Pt  =  vx 


Px  =  Vx 


the  second  rows  yield 


P(xs)  =  vx  +  2imu;2  +  km  Pmu>; 


Py  =  0, 


(2.24) 

(2.25) 

(2.26) 


(2.27) 

(2.28) 


Py  =  -k}P-2x  mu-kmx7m,  (2.28) 

P(y3)  =  -kji*  -  3 k,ifif  -  k'mx3m  -  -  3xmu>  -  3imc.  (2.29) 

2.3  Motion  properties  for  point  contact  between  curves 

It  will  be  useful  to  express  the  motion  relationships  in  both  the  contact  frame 
(the  *ryf  frame)  and  the  arc  length  coordinates.  The  position  constraints  are 
also  useful  in  determining  the  actual  contact  point. 

2.3.1  Motion  properties  expressed  in  the  contact  frame 

The  first  and  second  order  properties  for  contact  trajectories,  and  the  first  order 
through  third  order  properties  for  the  moving  point  have  been  considered. 

First  order  properties 

From  (2.9)  and  (2.18),  the  tangential  components  of  the  moving  and  fixed  contact 
velocities  are 

.  _  u  +  k,vx 


xm  =  - 


(km  +  kj)  ’ 


WWWJ 


-  ...  A  - 

V  V  v  ■ 


(3.1) 
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-u  +  kmvx 
(km  +  kf) 


(3-2) 


If  the  moving  body  is,  to  the  first  order,  undergoing  a  pure  rolling,  by  definition 
vx  =  0.  Therefore 


u> 

=  x'  =  ~(km  +  kJy 


(3-3) 


On  the  other  hand,  if,  to  the  first  order,  the  body  is  undergoing  pure  sliding,  by 
definition  u>  =  0.  Therefore 


hfvx 

(&m  +  k,y 


(3-4) 


'  "  (*m+*,)‘ 


(3.5) 


If  we  know  the  curve  curvatures  km,kj,  the  angular  velocity  u>  and  the  sliding 
velocity  vx  (for  a  robot  hand  the  sliding  velocity  is  computed  from  the  joint 
position  or  velocity  sensor  readings),  then  equations  (1)  and  (2)  determine  the 
al  contact  velocities. 


ii  we  tow  the  geometry  km,kj,  and  there  is  a  tactile  sensor  mounted  on  the 
moving  body  (such  as  on  a  finger  of  a  robot  hand),  we  can  calculate  im  from 
the  sensor,  and  then  we  can  compute  the  angular  velocity  w  needed  for  the  body 
to  move  under  pure  rolling  from  equation  (3),  or  we  can  compute  the  sliding 
velocity  vx  for  the  body  to  move  under  pure  sliding  from  equation  (4).  For  a 
general  motion  we  are  not  able  to  infer  both  u  and  vx  if  there  is  only  one  contact 
point  and  one  tactile  sensor,  but  we  can  if  both  the  moving  and  fixed  curves  have 
tactile  sensors.  This  follows  from  equations  (1)  and  (2). 


Alternatively  if  we  know  the  moving  body’s  motion  w,  vx  and  its  geometry  fcm, 
we  are  able  to  calculate  the  fixed  body’s  curvature  kf  from  equation  (1)  if  we 
have  the  tactile  sensor  reading  im.  This  property  can  be  useful  in  connection 
with  tactile  search  algorithms. 

From  (2.24)  and  (2.27),  the  moving  point  making  the  contact  has  velocity  vx 
along  its  direction  of  motion,  its  normal  velocity  is  zero,  which  is  as  expected. 
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Second  order  properties 

From  (2.10),  (2.19),  (1)  and  (2),  the  tangential  component  of  the  moving  contact 
accelerations  is 

-k/vx(krn  + kf)2  -  [(k'm(u  +  kfvx)2  +  k'f(-u  +  kmvx)2\  e  /0 

Im  (km  +  kf)3  +  V  ' 

and  that  of  the  fixed  contact  acceleration  is 

..  _  +  kf)7  -  +  kjVx)2  k'f{-U  +  fcmUx)2]  £ 


Xt  = 


(km  +k,)s 


km  +  k, 


(3.7) 


The  analysis  of  (6)  and  (7)  is  similar  to  that  of  (1)  and  (2):  knowing  km,  kf,  k'm,  k'j 
and  having  a  single  tactile  sensor  at  one  contact  does  not  give  enough  information 
to  uniquely  determine  both  the  sliding  and  angular  acceleration,  unless  both 
curves  contain  tactile  sensors,  which  allows  us  to  know  both  im  and  xf . 

If  a  motion  is  a  pure  rolling  to  second  order,  by  definition,  vx  =  vy  =  0,  vx  = 
vy  =  0,  and  hence  from  (6)  and  (7) 


-  =-  (*'m  +  *'f)"2 _ 

X/  (km  +  kf)3  km  +  kj 


(3.8) 


Not  only  the  contact  velocities,  but  also  the  contact  accelerations  with  respect 
to  both  the  fixed  and  moving  curves  are  the  same. 

If  we  know  the  geometry  (i.e.,  km,  kf,  k'm,  k'f)  and  w,  xm  or  i/,  (8)  can  be  used 
to  determine  the  angular  acceleration  c. 

For  pure  sliding  to  second  order,  by  definition  w  =  e  =  0,  and  therefore  from  (6) 
and  (7) 

-kfVx{km  +  k,f  -  ( k'mk )  +  k'fk7m)vl 

(km  +  kf)3 

„  _  kmvx{km  +  kf)2  -  ( k'mk )  +  k)k7m)v\ 

*’  ~  ( km  +  k,)3 

Once  we  know  the  geometry  (fcm,  kf ,  k'm ,  k'f),  from  xm  or  xf,  we  can  compute  the 
sliding  acceleration  vx  from  (9)  or  (10). 


xm  = 


(3.9) 

(3.10) 


£ 
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Now  we  look  at  the  acceleration  of  the  moving  point.  We  substitute  (1)  and  (2) 
into  (2.25)  and  (2.28),  and  obtain 


Px  —  i’xi  (3.11) 

w2 PmPf  1  2  ,  2 uvxpm 

py  = - vl  + - , 

Pm+P)  Pm  +  Pj  Pm  +  Pj 

where  pm  and  pf  are,  respectively,  the  radii  of  curvature  for  the  moving  and  fixed 

curves.  Alternatively,  (12)  can  be  written  in  terms  of  the  curvatures  as 


Py 


ur 


km  +  k, 


kmk,  .  2uvIkf 

- - — v  H - — . 

km  "h  k f  km  -f~  k  j 


(3.13) 


For  pure  rolling  up  to  second  order,  we  have  vx  =  0  and  vx  =  0,  so  from  (11)  and 
(13) 

Px  =  0,  (3.14) 

,2 


P  W  = 


U) 


(3.15) 


km  "F  kj 

This  result  is  well  known  in  kinematics.  (In  its  usual  form  the  fixed  normal  is 
taken  pointing  in  toward  the  center  of  curvature  and  therefore  kf  appears  with 
a  minus  sign.) 

For  pure  sliding  to  first  order  w  =  0,  (11)  and  (12)  yield 

Px  =  i’x,  (3.16) 

v 2 

Py  = - T—  •  (3-17) 

Pm  +  Pf 

The  acceleration  along  the  normal  is  proportional  to  the  product  of  the  sliding 
velocity,  and  inversely  proportional  to  the  sum  of  the  radii  of  curvature,  the 
smaller  the  sum,  the  larger  the  normal  acceleration  required  to  maintain  the 
contact  at  the  given  sliding  velocity. 


Equation  (17)  has  three  interesting  limiting  cases  as  illustrated  in  Fig.  2.4.  In  the 

first  case  the  moving  curve  becomes  a  point,  pm  shrinks  to  zero  (Fig  2.4a),  and  \ 

(17)  takes  its  classically  familiar  form.  (If  instead  pf  shrinks  to  zero,  the  result  is  ' 

j 

i 

l 

t 
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1/  («)  V  (*>) 


Figure  2.4  Limiting  cases  of  equation  (17) 

similar,  although  less  familiar.)  In  the  second  case  the  fixed  curve  becomes  a  line, 
pf  approaches  infinity  (Fig  2.4b).  Obviously,  when  a  curve  is  sliding  on  a  line, 
the  acceleration  in  the  normal  direction  must  be  zero  (If  instead  pm  approaches 
infinity,  the  same  situation  will  result).  In  the  third  case,  pm,pj  are  of  equal 
value  but  of  different  sign  (Fig.  2.4c),  the  acceleration  along  the  normal  must  be 
infinite  if  there  is  any  sliding  velocity,  but  it  is  physically  impossible  for  this  to 
occur. 

We  now  consider  the  sliding  velocity’s  effect  on  the  ym  component  of  the  velocity 
center’s  acceleration,  ay.  The  velocity  pole  is  along  ym  at  a  distance  d  =  vx/u> 
from  the  contact,  hence  subtracting  (vx/w)w7  from  (13)  it  follows  that  ay  is  zero 
if 

_  (fc/  ~  fcm)  ±  y /{km  ~  kf)2  +  4fcjfc7 

2  kmkf 

This  happens  when  d  takes  either  of  two  values,  d  =  \/km  or  d  =  —  \  /  k } .  When 
—pf<d<  pm,  ay  is  pointing  away  from  the  contact  point,  otherwise  it  is 
pointing  toward  the  contact  point.  When  d  =  pm  or  d  =  —pj,  ay  becomes 
zero.  In  general  ay  is  only  one  component  of  the  velocity  pole’s  acceleration. 
However,  if  e  =  vx  =  0  then  ay  is  the  total  acceleration,  which  is  known  to  equal 
w7(*mP  +  kfp )  (or  b2  u>2  if  we  use  b2  from  (1.3)),  where  kmp  and  kfp  are  the 
curvatures  of  the  moving  and  fixed  centrodes  at  the  velocity  pole. 


Chapter  2:  Planar  Motion  with  Point  Contact  21 


Third  and  higher  order  properties 

From  (2.26),  (2.29),  (1),  (2),  (6)  and  (7),  the  jerk  of  the  moving  point  becomes 

(3.18) 


/.x  ..  U)(u>  +  kfvx)[-(km  -f  2k})u>  +  kmk)Vx\ 

Px  —  «*  + - 


P(yS)  = 


km  +  k, 
1 


(fcm  +  kfY 

[(o;  +  kfvx)e  -  kf(-u>  +  kmvx)i>x] 


-[-^m(w  +  k/vx)3  +  k'j(-U)  +  ^mT)x)s]. 


(3.19) 


(km  +  kfY 

For  pure  rolling  to  the  third  order,  by  definition  vx  =  vy  =  0,  vx  =  vy  =  0,  vx  = 
vy  =  0.  From  (18)  and  (19),  the  third  order  time  derivatives  of  the  moving 
point’s  coordinates  become 


(a) _  ^>3{km  ~h  2 kf) 


Pt  = 
3 


(km  +  kfY  ’ 
1 


(3.20) 


(321) 

Let  us  take  a  simple  example  of  two  circles  contacting  each  other,  and  let  w  = 
1 ,  c  —  0.  If  the  circle  radii  are  pm  and  pf,  (20)  and  (21)  yield 


(3)  _  PjPmiPf  +  2 pm) 
Px 


( Pm+PfY 

p[3)  =  o- 

This  agrees  with  the  directly  calculated  results  in  [Roth  and  Yang,  ’77]. 


(3.22) 

(3.23) 


For  second  order  pure  sliding,  u>  =  e  =  0.  Hence,  equations  (18)  and  (19)  reduce 
to 

(3.24) 


P(,s)  =  vx, 


„(3)  -  3kjkmVxVx _ vl _  ,  ,  ,  .3  \ 

p»  -  km  +  kf  ( km  +  kfy{  +  W 


(3.25). 


Following  the  same  procedure  as  in  the  foregoing  section,  and  taking  the  higher 
derivatives  of  (2.8)  and  (2.14),  we  can  calculate  the  contact  relations  to  any 
arbitrary  order.  For  pure  sliding  of  the  moving  body  up  to  nth  order,  we  set 
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Figure  2.5  Distance  and  sense  of  arc  length 

dk$/dtn  =  0  for  k  =  1  to  n.  For  pure  rolling  of  the  moving  body  up  to  nih  order, 
we  have  V(fc)  =  0  for  t  =  0  to  n  -  1.  In  the  context  of  this  thesis,  properties 
higher  than  third  order  do  not  currently  have  practical  uses. 

2.3.2  Motion  properties  expressed  in  arc-length  coordinates 

We  define  sm  and  sf  as  arc  lengths  measured  from  Pm  and  Pj,  respectively,  with 
the  positive  senses  given  by  the  positive  xm,xf  directions  near  the  origin  (as 
shown  in  Fig.  2.5).  The  sliding  distance  is  sv  =  sf  —  sm.  The  sliding  speed  in 
arc  length  coordinates  is 

v  —  s  v  —  s  j  sm.  (3.26) 

The  rate  of  change  of  sliding  speed  in  arc  length  coordinate  is  v  =  s  —  sm.  By 
taking  derivatives,  higher  orders  terms  can  be  similarly  defined. 

A  scalar  A  is  referred  to  as  the  roll-slide  number  in  the  literature,  and  is  defined 
by  sm  =  A sf.  Hence,  v  =  (1  —  A)sr.  A  (or  its  equivalent)  is  a  useful  index 
that  has  been  basic  to  several  studies  [Blaschke  and  Muller,  ’56;  Bottema,  ’55, 
’75;  Bottema  and  Roth,  ’79;  Muller,  ’53,  ’63]  that  have  considered  motions  with 
constant  A.  In  our  case  A  is  generally  a  motion  variable.  If  A  =  1,  the  contact 
point  must  be  the  velocity  pole  of  the  moving  body.  We  will  in  places  also  refer 
to  A  in  our  study. 

At  the  zero  position,  contact  velocity  is  zero  in  the  normal  direction  (2.21). 
Obviously  then,  the  contact  speed  along  the  moving  and  fixed  curves,  sm  and  sf, 
must  be  the  same  as  the  contact  velocity  components  in  the  tangential  direction, 
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i.e., 


—  &  f  —  %  f 


(3.27) 


Combining  (27)  with  (1)  and  (2),  the  contact  speeds  in  terms  of  the  arc  length 
coordinates  are 

u  +  kjv 


S  m  — 


(*m  +  kf)' 
~u>  +  kmv 
'  ( km  +  kf)  ' 


8.  = 


(3.28) 

(3.29) 


,  (3.30) 


Although  (1)  and  (2)  are  only  associated  with  the  zero  position,  in  terms  of  the 
arc  length  coordinates  (28)  and  (29)  are  general  expressions  for  sm  and  s  Hence 
we  can  directly  take  derivatives  of  (28)  and  (29)  to  get  the  rates  of  change  of  the 
contact  speeds. 

..  _  -kfv{km  +  kfY  -  [( k'm(u  +  kfv )2  +  k'f{- u  +  fcmu)2]  t 

( km  +  kf )3  k^  +  kj 

..  _  kmv{km  +  kf)7  -  [(k'm(w  +  kjv )2  +  k'j{- u  +  k^v)2}  _  6  . 

3'  (km  +  kf)3  km  +  kf 

In  (4.4),  we  will  see  that  vx  =  v.  Combined  with  (6)  and  (7),  equations  (30)  and 
(31)  give 

5m  - —  xm,  Sj  Xj .  (3.32) 


In  real-time  control  calculations,  we  may  need  to  know  the  rates  of  change  of 
the  magnitudes  for  the  tangential  and  the  normal  acceleration  component.  We 
denote  them  as  a\  and  a'n.  (These  are  different  from  p^3)  and  which  refer  to 
the  moving  point,  a't  and  a'n  refer  to  Qm,  i.e.,  the  continuously  varying  contact 
points  on  the  moving  body.)  In  the  equation  for  the  tangential  acceleration  (11), 
we  replace  vx  by  v,  and  in  the  equation  for  the  normal  acceleration  (13),  we 
replace  vx  by  v.  Taking  the  derivative  with  respect  to  time,  we  have 


a 


n 


a[  =  i), 


(u)2  +  2 uivkf  +  k)v2)k'msm  (u>2  +  k2mv2  -  2u!vkm)k'fst 

(kZ+kJY2  (km  +  kf)2 

2 

+  t — — r-[w€  -  kmk f  vv  +  kf(tv  -I-  wv)]. 

*r  kf 


(3.33) 


(3.34) 


ywwwofryionr 
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For  pure  rolling  up  to  second  order, 


=  0, 

,  _  u,s(^m  d~  ^/)  2u;e 

( km  +  kfy  km  +  k,' 

For  pure  sliding  up  to  second  order, 


a  i  =  v, 


Wm  ~  klk'f)v>  2 


(km  +  kj)3 


km  +  k 


-kmkfvv. 


(3.35) 


(3.36) 


(3.37) 


(3.38) 


2.3.3  Calculation  of  contact  position 

Given  the  first  order  contact  speed  equations  (28)  and  (29),  we  can  theoretically 
get  the  contact  position  by  integration.  In  real-time  control,  since  the  integration 
is  performed  on  discrete  time  sampled  data,  error  will  accumulate.  An  alternative 
way  is  to  use  global  constraints  to  get  the  desired  contact  position.  Arc  lengths 
and  rotation  angles  provide  useful  information  for  accurately  locating  the  contact 
position. 

Arc  length  constraints 

In  (28)  and  (29)  when  krn  and  kj  are  invariant,  i.e. ,  we  have  two  circular  curves 
(one  can  be  a  line)  in  contact,  the  equations  can  actually  be  integrated.  sm  = 
[-$  -  kfsv]/(km  +  kf),  sf  =  [-$  +  fcms„]/(fcm  +  k{),  where  sv  is  the  sliding 
distance,  and  $  is  the  angle  the  moving  object  rotates  through.  Usually  we  know 
$  from  position  sensors  in  the  joints  of  the  moving  system,  and  if  there  is  a  tactile 
sensor  mounted  on  the  moving  body  we  also  know  the  moving  contact  distance 
sm,  then  from  the  expression  for  sm  we  know  sv  the  sliding  distance.  From  the 
sf  expression  we  know  s;,  which  gives  the  contact  position  on  the  fixed  body. 

In  general  for  other  than  circular  curves,  (28)  and  (29)  can  not  be  explicitly 
integrated.  However,  for  pure  rolling  contact,  since  sm  =  sf,  if  we  have  a  tactile 


V.v.v.v . 
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sensor  which  gives  arc  length  sm,  we  can  infer  the  exact  position.  For  pure 
sliding,  when  km  =  ks  we  have  sm  =  — (l/2)s„  and  sf  =  (l/2)s„.  This  happens 
when  two  anti-symmetric  curves  are  in  contact  and  there  is  no  rotation.  For  the 
general  cases  of  pure  sliding,  from  (2.9)  and  (27) 


=  -/^v 


(3.39) 


If  we  know  s  ,  by  integration  we  know  the  exact  arc  length  of  sm.  The  integration 
limit  is  determined  by  sf.  and  at  each  position  the  corresponding  km  can  be 
determined  from  the  condition  that  the  contact  normals  must  be  coincident. 

When  kj  is  proportional  to  km  (i.e.,  their  ratio  is  constant),  sm  is  linearly  pro¬ 
portional  to  sf  by  the  same  constant  factor.  From  (2.9)  and  (27)  we  can  show 
that  the  constant  is  the  roll-slide  number  A. 

Rotation  angle  constraint 

There  is  a  global  constraint  for  the  rotation  angle,  which  is  required  of  any  mo¬ 
tion.  Substituting  (27)  into  (2.9)  and  integrating,  we  have,  f  kfdsf  +  J  k^dsm  = 
—  J  ujdt.  Here,  we  have  used  the  relations  dsm  —  smdt  and  ds  f  =  sfdt.  From  the 
definition  of  curvature  (we  take  the  sign  convention  such  that  the  positive  sense 
of  Nm  or  N j's  rotation  angle  with  respect  to  its  frame  corresponds  to  a  decrease 
in  the  arc  length),  kfdsf  =  —d$f,  and  kmdsm  =  — d$m.  Substituting  this  into 
the  above  integral  equation,  we  have, 


<pm  +  <p,  = 


(3.40) 


Equation  (40)  tells  us  that  the  rotation  angle  of  the  moving  curve  with  respect 
to  the  fixed  space  is  the  sum  of  the  rotation  angles  of  the  inward  pointing  normal 
with  respect  to  the  moving  frame  and  that  of  the  outward  pointing  normal  of  the 
fixed  curve  with  respect  to  the  fixed  frame  (Fig.  2.6).  This  equation  appears  to 
be  very  useful.  If  a  tactile  sensor  has  been  mounted  on  a  moving  body,  since  we 
always  know  the  rotation  angle  of  the  moving  body  and  we  can  use  the  sensor 
to  obtain  the  rotation  of  the  moving  normal,  we  can  use  (40)  to  calculate  the 
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to 


Figure  2.6  Relationship  among  rotation  angles 


Figure  2.7  Special  geometries  for  point  contact  between  curves 

rotation  angle  of  the  fixed  curve’s  normal.  Knowing  the  normal,  we  can  search 
out  the  exact  contact  position  on  the  fixed  curve. 

2.4  Special  geometry  of  contacting  curves 

There  are  several  special  cases  that  require  additional  discussion  (Fig.  2.7):  1) 
the  moving  curve  is  a  point  (for  example,  the  moving  contact  is  a  sharp  point 
of  a  tool),  2)  the  fixed  curve  is  a  point  (  a  workpiece  has  a  sharp  point),  3)  the 
moving  curve  is  a  line  ,  and  4)  the  fixed  curve  is  a  line. 

Moving  curve  is  a  point 

We  can  model  the  contact  point  as  the  limiting  case  of  a  circular  curve,  i.e.,  km 
approaches  oo  and  k'm  =  0.  From  (3.1)  and  (3.27)  for  im,  and  from  (3.6)  and 
(3.32)  for  im,  the  contact  velocity  and  acceleration  with  respect  to  the  moving 


Chapter  2:  Planar  Motion  with  Point  Contact  27 


frame  are,  respectively, 


i'm  =  sm  =  0,  xm  =  sm  =  0. 


In  fact,  x[^>  =  0,  hence  =  0,  and  the  contact  point  is  stationary  in  the 
moving  system. 

From  (3.2)  and  (3.27)  for  xf,  and  from  (3.7)  and  (3.32)  for  i/t  the  contact 
velocity  and  acceleration  with  respect  to  the  fixed  frame  are,  respectively, 


x .  =  a ,  —  iK,  x.  =  s .  =  vx. 

f  /  /  /  1 


m 


The  contact  velocity  along  the  fixed  curve  and  its  derivatives  are  determined 
from  the  sliding  velocity  and  its  derivatives.  This  can  be  seen  clearly  from  (2.15) 
and  (2.16).  (If  a  single  tactile  sensor  is  mounted  on  the  fixed  curve,  no  rotational 
information  can  be  inferred  from  the  sensor  reading.) 

Considering  the  roll-slide  number  A,  from  (1)  and  (2)  we  see  that  in  this  case 
A  =  0. 

From  (3.13),  (3.19)  and  (3.3d),  the  normal  acceleration  of  the  moving  point  and 
its  rates  of  change  are,  respectively, 

Py  =  -kfvl,  (4.3) 

P(y]  =  -3  kfvxvx  -  k'jvl,  (d.‘l) 

a'n  =  —k'jV3  —  2kfvi).  (4-5) 

Notice  that  these  quantities  are  the  same  as  the  sliding  velocity  and  its  higher 
order  derivatives,  and  also  the  contact  velocity  and  its  higher  order  derivatives  on 
the  fixed  curve.  This  can  be  seen  from  (2.15)  and  (2.16),  since  from  (1)  A'm  and 
Afm  vanish.  For  pure  sliding,  equations  (3)-(5)  show  that  the  normal  acceleration 
and  its  rates  of  change  are  larger  than  when  the  contacting  curves  are  convex. 
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Fixed  curve  is  a  point 

To  study  the  fixed  curve  as  a  point,  let  kj  approach  oo  and  k'f  =  0.  The  contact 
velocity  and  acceleration  with  respect  to  the  fixed  frame  are,  respectively, 

i,  =  =0,  z,  =  s,  =  0.  (TG) 

The  contact  velocity  and  its  higher  order  derivatives  on  the  fixed  curve  all  vanish 

The  contact  velocity  and  its  derivative  with  respect  to  the  moving  frame  are, 
respectively, 

X  rn  m  V x  1  X  m  S  m  V  x  •  ( '1  ■  7 ) 

These  are  in  the  negative  sense  to  the  sliding  velocity  and  its  derivative. 

Considering  the  roll-slide  number  A,  from  (6)  and  (7)  we  see  A  =  oo  in  this  case. 

From  (3.13),  (3.19)  and  (3.34),  the  moving  point’s  normal  acceleration  and  its 
rates  of  change  are,  respectively, 


Py  =  -kmV2x  +  2UVX, 

(4.8) 

=  3uxf  -  3(— w  +  kmr\)vx  +  k'mvsz, 

(4.9) 

n  =  Knv*  -  2 {kmvv  -  IV  -  ui>). 

(4.10) 

The  sliding  velocity  is  the  dominant  term. 


Moving  curve  is  a  line 


We  take  km  and  k\n  to  be  zero.  From  (3.1)  and  (3.27)  for  xm,  and  from  (3.G)  and 
(3.32)  for  xm,  the  contact  velocity  and  acceleration  with  respect  to  the  moving 
frame  are,  respectively, 


= 


u> 


=  S. 


—  »>r  - 


k! 


(4.11) 


From  (3.2)  and  (3.27)  for  t{,  and  fror.  (3.7)  and  (3.32)  for  i;,  the  contac 
velocity  and  acceleration  with  respect  to  the  fixed  frame  are,  respectively, 


T  =  .« 

/  I 


UJ 

V, 


s,  =  - 


k’fw2 


*/ 


(4.12) 


-  ■  -  *  —  *  •*  "  *-  * 
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These  depend  only  on  the  angular  velocity  and  angular  acceleration.  Hence,  if 
we  can  determine  the  fixed  contact  velocity  and  contact  acceleration,  these  can 
be  used  to  determine  the  angular  velocity  and  angular  acceleration. 

Considering  the  roll-slide  number  A,  from  (11)  and  (12)  we  see  that  A  =  1  +  vxkf/ 
u\  for  pure  sliding,  A  =  oo. 

From  (3.13),  (3.19)  and  (3.34),  the  moving  point’s  normal  acceleration  and  its 
rates  of  change  are,  respectively, 


Py=  T  +  2uJV '»• 
kf 


3  ft* 

P(y3)  =  £j[(w  +  kfvx)e  +  k}ui'x ]  +  — - 

k'.u3  2 

a„  =  -jj-  +  —  (we  +  kfev  4-  uv). 


(4.13) 


(4.14) 


(4.15) 


In  expressions  (13)-(15),  the  rolling  is  the  dominant  part. 

Fixe  d  curve  is  a  line 

If  the  fixed  curve  is  a  line,  then  kj,  k'f  are  zero.  The  contact  velocity  and  accel¬ 
eration  with  respect  to  the  moving  frame  are,  respectively, 


Id  ..  ..  k'u)7 


^  m  >  5  %  m  ^  m 


^  m  Km 


(4.16) 


Hence,  the  contact  velocity  and  acceleration  are  only  functions  of  rolling  of  the 
moving  body. 

Similarly,  the  contact  velocity  and  acceleration  with  respect  to  the  fixed  frame 
are,  respectively, 


id  ..  ..  k'u>2  e 


*,  =*/  =  -r-  +  t,*«  x,=s,  =  — + 


(4.17) 


Considering  the  roll-slide  number  A,  from  (16)  and  (17)  we  see  A  =1/(1  -vxkj 
w);  for  pure  sliding  A  =  0. 
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From  (3.13),  (3.19)  and  (3.34),  the  moving  point’s  normal  acceleration  and  its 
rates  of  change  are,  respectively, 


w2 

(4.18) 

py  ~  l  ’ 

^  m 

pW  =  W€  +  -f—, 

"  km  k3m 

(4.19) 

.  k'ui3  2ue 

(4.20) 

n  ~  k3  ^  Jfc 

Km  Km 

With  regard  to  the  normal  acceleration,  the  rolling  is  the  dominant  aspect. 

2.5  Planning  planar  motion  with  point  contact 

In  preceding  sections,  we  have  derived  analytic  expressions  for  the  moving  point’s 
trajectory  and  contact  trajectories  in  terms  of  the  motion  parameters  (i.e.,  which 
are  related  to  the  sliding  velocity  and  sliding  acceleration,  as  well  as  the  body’s 
angular  velocity  and  angular  acceleration).  We  now  discuss  how  one  can  deter¬ 
mine  the  motion  parameters  from  path  planning. 

Sliding  speed  planning 

Assume  first  that  we  know  the  desired  sliding  speed  for  the  direct  contact:  the 
Taylor  expansion  of  the  sliding  velocity,  which  is  defined  in  (2.16),  is 

T(0  =  K(0)  +  T(0)t  +  ^M/2  +  ...,  (5.1) 

The  Taylor  expansion  of  the  sliding  speed,  which  is  defined  in  (3.2C),  is 

t/(0  =  v(0)  +  v(0)t  +  ^t2  +  . . . .  (5.2) 

If  the  desired  v(0),  v(0),  i)(0), . . .  have  already  been  defined,  then  we  can  calculate 

T(0),  T(0),  T(0), _  We  notice  from  (2.21)  that  for  all  time  the  sliding  velocity 

must  be  parallel  to  Tj  the  unit  tangent  vector  of  the  fixed  curve.  Thus 

V(0)  =  n(0)r/,  (5.3) 


N  kr*  .  r.M  «'» 


•  ’  I  ^ ■'J*~**w ”  *  *"»«  ’*  1  *'«  *  *  ' 
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V(0)  =  5(0)7} +i/(0)T>,  (5.4) 

V(0)  =  ti(0)T>  +  2i?(0)T>  +  i/(0)f,.  (5.5) 

T f  can  be  expressed  as 

r'(,) -(£:)  =  7 rr^{-L)  (5-6) 

By  definition,  for  the  outward  pointing  unit  normal  of  the  fixed  curve,  from  (2.5) 
we  have  fg  =  T™  =  -  N%. 

One  interesting  case  is  for  pure  rolling  up  to  nth  order.  We  have 


i/(0)  =  5(0)  =  ii(0)  =  . . .  =  vin~l)(0)  =  0 


(5.7) 


From  the  above  we  see  immediately  that 

V(0)  =  y(0)  =  V(0)  =  . . .  =  V(n-°(0)  =  0.  (5.8) 

This  shows  that  for  pure  rolling,  up  to  nth  order,  defining  the  derivatives  of  the 
sliding  velocity  vector,  Vr(*),  to  be  zero  (for  k  from  0  to  n  —  1)  is  the  same  as 
setting  the  derivatives  of  the  sliding  speed  scalar,  v(k),  to  zero  (for  k  from  0  to 
n  -  1). 

Another  interesting  case  is  constant  sliding  speed.  This  is  considered  desirable 
for  minimizing  frictional  heat  generation  and  improving  the  quality  of  machining 
and  other  operations  which  are  sensitive  to  the  sliding  speed.  The  required 
conditions  are  of  course 


w(<)=t,(0),  t/(0)  =  5(0)  =  ...  =  i/(n)(0)  =  0.  (5.9) 

By  substituting  the  expressions  for  Tf,Tf,  and  equation  (9)  into  (4)  and  (5),  we 
have 


«x(0)  =  o, 


(5.10) 


”2v  _ 


=  -k2fx]vx(0)- 


M0) 


Mo)  =  - 


(5.11) 
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Contact  speed  planning 

Next,  we  assume  we  know  the  contact  speed  along  the  fixed  curve:  we  notice  that 
the  contact  velocity  with  respect  to  the  fixed  curve  as  defined  by  the  derivative 
of  (2.11)  must  be  parallel  to  the  unit  tangent  vector  of  the  fixed  curve  for  all 
time.  Hence  the  contact  velocity  and  the  contact  speed  with  respect  to  the  fixed 
curve  are  related  to  each  other  by  relationships  similar  to  those  we  have  obtained 
for  sliding  velocity  and  sliding  speed.  When  s f  (0),  sf  (0), . . .  are  specified,  we  can 
calculate  the  contact  velocity  and  its  rates  of  change  Xf,  Xf, . . .. 


One  interesting  case  is  that  of  constant  contact  speed,  by  definition 

i,(0  =  M  0),  5,(0)  =  »J*>  =  •  •  •  =  *<">  =  0. 


By  calculation,  we  have 


i,(0)  =  i,(0), 

*,(0)  =  s,(0)  =  0, 


(5.12) 


(5.13) 

(5.14) 


(5.15) 


For  constant  contact  speed  equations  (13)  and  (14)  impose  a  constraint  on  equa¬ 
tions  (3.2)  and  (3.7),  respectively. 

Planning  the  contact  speed  with  respect  to  the  moving  curve  will  essentially 
follow  the  same  procedure  as  with  respect  to  the  fixed  curve,  except  that  sf 
should  be  replaced  by  sm  and  Tf  by  Tm. 

Orientation  path  planning 

Finally,  we  assume  we  know  the  desired  orientation  of  the  moving  system  as  it 
moves  under  point  contact:  to  plan  the  rotation  with  respect  to  the  fixed  space, 
uj  and  c  need  to  be  specified.  A  special  case  is  pure  sliding.  When  considering  the 
roll-slide  number  A,  from  (2.9)  and  (3.27)  we  see  that  for  pure  sliding  A  =  —  kf/ 
km.  From  (2.10)  and  (3.32)  we  see  that  A  =  —  (k'mk2j  +  k'fk7m)s  f  /k^,  where  A  is 
the  time  derivative  of  A.  For  two  circular  curves  undergoing  pure  sliding,  A  =  0. 
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Another  way  is  to  plan  the  moving  curve’s  orientation  with  respect  to  the  fixed 
curve’s  contact  normal.  If  we  let  the  the  moving  body’s  orientation  be  always 
coincident  with  the  fixed  curve’s  current  normal 

$  =  <!>,.  (5.16) 

From  (2.9)  and  (3.27),  since  the  contact  trajectory  with  respect  to  the  moving 
frame  becomes  a  point,  we  have 


Ld  =  k jS j  .  (5.17) 

Taking  a  derivative,  and  maintaining  constant  contact  speed, 

e  =  ~k'fP.  (5.18) 

The  fixed  contact  trajectory  is  the  same  as  the  moving  point  trajectory  in  this 
case. 

In  terms  of  the  roll-slide  number  A,  for  this  special  motion  we  have  A  =  A  = 
. . .  =  A(n)  =  0. 

Determining  the  planar  finger  motions 

Now  we  give  an  example  of  finger  path  planning  to  illustrate  the  path  planning 
process.  Given  the  desired  motion  of  the  moving  body  with  respect  to  the  fixed 
space  (for  the  moving  body  the  contact  point’s  velocity  vm  and  acceleration  am 
can  always  be  calculated),  we  can  determine  v  (the  velocity  at  the  contact  point 
of  the  moving  body  with  respect  to  the  finger)  or  ui  (the  angular  velocity  of  the 
moving  body  with  respect  to  the  finger)  or  both  by  planning  the  relative  contact 
position  and  orientation,  as  explained  earlier  in  this  section.  From  (B2)  and  (B3) 
we  can  calculate  the  finger  tip  velocity  vf ,  from  which  we  can  determine  the  joint 
rates  ©  by  using  the  inverse  Jacobian  of  the  finger  [Salisbury  and  Roth,  ’83] 

0  =  J-,v/.  (5.19) 
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Having  the  joint  rates,  we  can  calculate  the  angular  velocity  of  the  finger.  For 
a  two-degree-of-freedom  finger  0  =  (0i,02 ]T  and  hence  u)  =  0,  +  02.  From 
the  relative  motion  planning,  we  can  further  select  a  (the  acceleration  of  the 
moving  body  at  the  contact  point  with  respect  to  the  finger),  then  from  (B4) 
and  (B5)  we  can  calculate  the  finger  tip  acceleration  a/,  from  which  the  desired 
joint  accelerations  can  be  determined: 

0  =  J~l(af  -  JQ).  (5.20) 

For  a  two-degree-of-freedom  finger,  the  angular  acceleration  of  the  finger  tip  is  c  = 
6i  -t-02.  Thus  we  have  determined  the  required  joint  velocities  and  accelerations 
in  terms  of  the  motion  variables  given  by  the  planning  considerations  outlined  in 
the  foregoing  paragraphs. 

2.6  Two  point  contacts  between  curves 


Figure  2.8  Two  points  contact  between  curves 


As  is  well  known  and  as  we  reaffirmed  in  section  3,  the  angular  velocity  and 
angular  acceleration  of  a  moving  body  are  generally  not  uniquely  determined 
by  one  point  contact.  It  is  well  known  that  the  geometric  aspects  of  a  planar 
motion  are  uniquely  determined  by  two  point  contacts.  In  this  section  we  will 
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derive  relationships  for  the  motion  variables  when  there  are  two  point  contacts. 
We  consider  a  moving  planar  body  represented  by  a  planar  curve,  which  may  be 
a  compound  curve  made  up  of  several  different  segments  which  all  move  together 


ft# 
>1® 

Pi. 


as  one  rigid  body.  We  will  refer  to  this  as  “the  moving  body”.  This  body  will 
be  required  to  move  so  as  to  maintain  point  contact  along  its  curve  with  two 
separate  curves  -  which  we  will  call  fingers.  Each  of  the  fingers  is  capable  of 
independent  motion  relative  to  a  fixed  space. 


Fig.  2.8  shows  the  two  fingers  and  the  moving  body.  We  refer  to  one  of  the 
fingers  as  finger  1  and  the  other  as  finger  2,  and  we  refer  to  their  contact  points 
as,  respectively,  contact  points  1  and  2.  If  we  connect  the  contact  points  with  a 
straight  line  of  length  d  and  give  this  line  direction  n  and  transverse  direction  t, 
then  from  Fig.  2.8  it  follows  that, 

t,  n2  =  —  sin(ar,  +  a2),  n,  n2  =  cos(a1  +  ar2),  t-n2  =  — cosa2,  nn3  =  -sinar2 


(6.1) 

We  adopt  the  following  notations:  we  use  the  subscript  j  to  denote  the  jth  finger 
and  also  the  jth  contact  point;  j  can  be  either  1  or  2.  If  we  start  at  an  arbitrary 
configuration  and  a  motion  occurs,  then  in  any  subsequent  position,  is  the 
contact  normal’s  rotation  angle  with  respect  to  the  moving  body  at  the  finger 
contact  j,  is  the  contact  normal’s  rotation  angle  with  respect  to  finger  j; 
wm  and  cm  are  the  moving  body’s  angular  velocity  and  angular  acceleration 
with  respect  to  the  fixed  space;  w_,  and  are  the  angular  velocity  and  angular 
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acceleration  of  finger  j;  u>,  and  €j  are  the  moving  body’s  angular  velocity  and 
angular  acceleration  with  respect  to  finger  j;  vmj,amj  are  the  moving  body’s 
velocity  and  acceleration  at  contact  position  j\  v j}  and  a f}  are  the  jtU  finger’s 
velocity  and  the  acceleration  at  its  contact  point;  v,  and  a^  are  the  moving 
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body’s  velocity  and  acceleration  at  the  jth  contact  point  with  respect  to  finger  j; 
if,  and  Sjj  are  the  contact  velocity  and  acceleration  (in  arc  length  coordinates) 
for  finger  j;  kmj  is  the  moving  body’s  curvature  at  contact  point  j  ;  k!}  is  the 
jtk  finger’s  curvature  at  the  contact  point.  For  our  current  study  we  need  to 
consider  all  the  contacting  bodies  as  being  in  motion.  To  study  these  motions 
it  becomes  useful  to  introduce  a  stationary,  or  absolute,  frame.  In  Fig.  B.l 
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of  Appendix  B  we  show  the  basic  geometry  at  one  contact,  and  list  the  basic 
kinematic  equations  for  the  case  where  both  bodies  /  and  m  are  in  motion. 

Calculating  the  contact  position  from  two  contacts 

From  (2.9),  (3.27)  and  Appendix  B  (Bl),  for  the  configuration  in  Fig  2.8  we  have 

J 1  &  j  i  ~b  i.ml  ^  ml  ^  tn  “b  ,  l'  /2  ®  ""b  ^  m2  ^  m2  '  ^m  ~b  ^2  (6.2) 

If  we  integrate  these,  we  obtain 

$/l  +$ml  =  *  -  *1.  (6-3) 

$/2  +  $m2  =  $  -  $2-  (6.4) 

where  the  positive  senses  of  &fj  and  are  consistent  with  those  defined  in 
(3.40).  If  we  know  the  finger  motions  and  we  know  the  finger  contact  points, 

then  we  know  $/! ,  $/2,  $1  and  <h2,  so  there  are  three  unknowns,  <I>ml,  <I>mi ,  in 

the  two  equations.  However  if  there  are  contact  sensors  in  the  fingers,  we  have  an 
additional  constraint  due  to  the  contact  positions  determined  from  the  contact 
sensor  readings.  This  provides  a  simple  iterative  algorithmic  way  to  determine 
$>:  If  we  assume  an  arbitrary  $,  then  from  (3)  we  can  determine  <£ml ,  thus  the 
first  contact  on  the  moving  body  (after  rotation)  is  temporarily  determined.  This 
point  is  coincident  with  the  contact  point  on  the  first  finger.  From  (4)  we  can 
solve  for  <I>m2  using  the  previously  assumed  <E>,  hence  the  second  contact  point 
on  the  moving  body  is  determined.  This  contact  on  the  moving  body  will  be 
coincident  with  the  second  finger’s  contact  point  if  $  is  correct,  otherwise  it 
indicates  that  our  assumed  $  is  incorrect.  If  is  incorrect,  we  choose  a  new 
value  for  it  based  on  any  of  the  well  known  one-dimensional  search  techniques, 
and  repeat  this  procedure  until  it  converges  to  a  correct  <i>. 

Calculating  the  angular  velocity  from  two  contacts 

To  calculate  the  angular  velocity  from  two  contacts,  from  (3.29)  ,  (Bl)  and  (B2), 
we  have, 
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Since  the  contact  points  on  the  moving  body,  ml  and  m2,  are  both  points  on 
the  same  rigid  body  under  planar  motion, 

vm2  =  (vrai  •  t,)t,  4  (vml  •  n,)n,  -  U)mdt.  (6.6) 

If  we  take  the  n2  component  of  (6)  and  substitute  from  (1),  we  get 

vm2  •  n2  =  (vm[  •  t,)sin(a,  4-a2)  4  (vm,  •n1)cos(or1  4  a2)  4- wmdcosa2.  (6.7) 

vmi  *  tj ,  vml  it!  and  vm2n2  can  be  obtained  from  (5)  and  (B3).  By  substituting 
these  into  (7),  we  get  a  formula  for  ujm, 

1  r  ■  i  \  r  (^ml  4"  &/i)  . 

Vm  =rj - t~-  i - [ - wT — rri- sm(ai  4  a2)[- — - s 

[dcosa2  —  (310(0:!  4-  a2)/*mi)j  fcm,  ' 

-  jr~  +  v„  •  t,]  4  vfl  ■  n,  cos(or,  4-  or2)  -  v/2  ■  n2}. 

Equation  (8)  can  be  used  to  determine  the  moving  body’s  angular  velocity  if  the 
fingers’  motions  are  known  and  one  finger's  contact  speed  is  available  from  the 
tactile  sensors.  From  (3.29),  we  can  calculate  the  sliding  speed  at  the  contacts, 
hence  the  motion  of  the  moving  body  to  first  order  is  completely  known. 

Calculating  the  angular  acceleration  from  two  contacts 
To  calculate  the  angular  acceleration  from  two  contacts,  from  (3.31), 

_  ^ml  (^ml  —  )  '^1  —  fin  4"  C] 

S/1  (&ml  4-  kfi  )  &ml  4  kf] 

K’m|(Wl  4-  kfl\l  ■  t^2  4  &},(—  Wi  4-  fcmlVl  •  tl)2] 

{kml  4-  fc/j  )3 


We  know  that  since  ml  and  m2  are  two  points  on  the  same  rigid  body, 


a  m2  =  ami  -  €mdt  -  ui2dn. 


Taking  the  n2  component  of  (10)  and  substituting  from  (1)  yields, 


(6.10) 


am2  n2  =  -(aml  t,)sin(ar,  4or2)  +  (ami  nt)cos(ai  4a2)4u;^dsina2  4cmdcosa2 

(6.11) 


f,wvv.. 
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am,  •  ti  can  be  obtained  from  (9),  and  from  (B5)  we  can  obtain  an  expression  for 
aml  •  n,  and  am2  ■  n2,  in  which  we  use  a,  • n,  and  a2  •  n2  as  obtained  from  (3.13). 
By  substituting  these  into  (11),  we  obtain  a  formula  for  em, 

[dcosa2  -  (sin(a,  +  a2)/*m,)]  sin  a>  a2  [a/i  i  *ml  s> 1 

—  7~  +  I — 71 — TT — +  kjiY!  ■  t,)2  +  k'fl(- u>i  +  fcmlv,  •  t[)2) 

"'ml  l) 

+  w^dsina2  +  €05(0!  +  a2)  +  [a/t  •  nt  +  2u>) v,  ■  t, 

.  ,  ,  w  *ml*/l  -2  ,  2d>i  V,  •  tllcjl  . 

+  cos(a,  +  aa)[— —  -  ■ r—rr -v?  +  "  T~TkT  1 

"•ml  1  "/I  "-ml  T  "•/ 1  "ml  i  Kj\ 


-  (a/2  •  n2  +  2w2v2  •  t2  + 


UJ*  km2^f2  ^2  2U12V2  •  t2fcy2  . 

^  m2  +  kf  2 

^  m2  +  k  j2  km2  +  ^/2 


(6.12) 


Equation  (12)  can  be  used  to  determine  the  moving  body’s  angular  acceleration 
if  the  fingers’  motions  are  known  and  one  contact  velocity  and  acceleration  are 
available.  From  (3.31)  we  can  calculate  the  sliding  acceleration  at  the  contact 
points.  Hence  the  motion  of  the  moving  body  to  second  order  is  completely 
known. 


Special  geometry 

From  equations  (8)  and  (12)  we  obtain  simplified  expressions  for  the  angular 
velocity  and  acceleration  for  the  following  three  special  cases:  the  moving  curve 
reduces  to  two  lines,  the  finger  curves  reduce  to  lines,  the  moving  curve  reduces 
to  two  points. 

When  the  moving  curve  is  reduced  to  two  lines,  kml,  k^n,  k'^j  and  k'm2  are  all 
zero,  and  kmi/km2  —  1.  From  (8), 

wm  =  ~kfiSfl  +U>!. 

This  is  essentially  the  same  expression  as  for  lj  in  (4.12)  when  combined  with 
(Bl).  For  angular  acceleration,  from  (12), 


Cm  =  ~kfl'sn  +  Cj  ~ 


k'fltf 


snwrsrv 
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This  is  essentially  the  same  expression  as  for  c  in  (4.12)  when  combined  with 

(Bi). 


The  next  case  we  consider  is  when  the  moving  curve  is  general  but  both  finger 
curves  are  lines.  We  let  kfl  —  k'fl  =  0  and  kt2  =  k'f2  —  0  in  (8), 


-1 


- - — - rj-. — :{  — sin(ft,+ttj)[s  -^-  +  v  d,] 

[dcoso2  -  sin(a,  +  a2)/*ml]  km ,  n 

+  v;i  •  n,  005(0;!  +  o2)  -  v/2  •  n2}. 

(6.13) 

For  angular  acceleration  from  (12), 


Cm  = 


[dcosa2  —  sin(at  -f  ot2)/krnl)  ^  sin(ai  +  a2Ha/i  t'+5/i  £mi 


kf  u2  w 

+  -]  +  cos(o,  +  a2)[a  ■  ii,  +  2c,*! v,  ■  t,  +  — ^]  +  sino2 

^  ml 


^  ml 


U>1 


-  (a  ■  n2  +  2w2v2  ■  t2  +  --^-)} 


(6.14) 


The  third  case  we  consider  is  when  the  curve  of  the  moving  body  is  reduced 
to  two  points.  For  this  case  from  (4.2)  we  notice  that  with  one  contact  we  can 
only  sense  the  sliding  velocity,  however  with  two  contacts  we  can  also  sense  the 
rotation  of  the  object.  We  let  kml  and  &m2  approach  00,  but  ^mi/fcm2  =  1  and 
*mi  =  =  0.  then  from  (8) 


-1 


wr 


{-sin(a,  +  a2)[s/t  +  v;i  ■  t,]  +  v;i  •  n,  cos(o,  +  o2)  -  v/a  ■  n2} 

(6.15) 


d  cos  o2 

The  angular  acceleration  can  be  obtained  from  (12) 


^  m 


dcoso  ^~sin^1  +  ' tj  +  */il  ~  (a/2  ■  n2  +  2w2v2  •  t2  -  k]7\\) 

+  cos( oc !  +  or2)[an  ■  n,  +  2u>,v,  ■  t]  -  +  u>^dsinor2}. 

(6.16) 


Equations  (8)  and  (12),  as  well  as  their  special  cases,  can  be  used  for  path 
planning  with  two  contacts.  An  unconstrained  planar  motion  involves  three 
degrees  of  freedom.  The  two  contacts  remove  two  of  these  freedoms,  and  the 
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one  remaining  degree-of-freedom  can  be  used  to  plan  the  contact  velocity  and 
acceleration  (at  one  contact),  or  the  sliding  velocity  and  acceleration  (at  one 
contact).  Once  the  motion  at  one  contact  is  specified  the  orientation  is  completely 
determined  by  equations  (8)  and  (12). 

We  notice  that  in  equations  (8)  and  (12),  when  both  segments  of  the  moving  curve 
form  a  portion  of  one  circle,  the  denominators  of  these  equations  will  be  zero, 
and  hence  the  rotation  motion  is  indeterminate.  This  is  obvious  since  a  circle 
can  always  rotate  about  its  center  at  an  arbitrary  rate  without  being  afTected  by 
the  contacting  supports. 

This  completes  our  study  of  planar  motions,  in  the  next  chapters  we  consider 
spatial  motions. 
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Chapter  3 


SPATIAL  MOTION  WITH 
POINT  CONTACT 


Figure  3.1  Arbitrary  position  of  a  moving  surface  in  point  contact 

In  this  chapter,  we  study  the  instantaneous  spatial  motion  of  a  rigid  body  with 
point  contact  between  two  surfaces.  The  moving  point  Pm  is  a  contact  point  on 
the  moving  surface,  and  the  contact  trajectories  of  Qm  and  Q /  are  the  loci  of 
the  contact  points  on  the  moving  and  fixed  surfaces,  respectively.  In  general,  the 
moving  body  is  rolling  and  sliding  on  the  fixed  body.  We  also  define  as  a 
new  contact  point  on  the  moving  body  after  a  given  time  interval.  P'm  will  be 
coincident  with  Pm  when  the  time  interval  approaches  zero.  The  basic  relation¬ 
ships  between  the  roll-sliding  motion  of  the  moving  object  and  the  moving  point’s 
trajectory  and  contact  trajectories  are  our  main  focus.  We  are  also  interested  in 
two  special  motions,  pure  rolling  and  pure  sliding. 
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Following  a  similar  route  as  in  the  last  chapter,  we  start  with  the  basic  contact 
constraints,  then  obtain  from  them  the  motion  properties  at  the  point  of  contact. 
An  example  of  spatial  motion  with  point  contact  between  two  spheres  is  included 
to  illustrate  these  properties.  The  variations  in  these  properties  for  special  ge¬ 
ometries  where  either  surface  becomes  a  point,  a  line  and  a  plane  are  listed.  We 
also  consider  trajectory  planning  for  the  roll-sliding  variables  and  for  motions 
with  multiple  contacts. 

3.1  Constraints  on  point  contact  between  surfaces 

The  essential  motion  constraints  are  due  to  restrictions  on  the  contact  normal, 
contact  trajectories,  and  the  moving  point  trajectory. 


Figure  3.2  Initial  position  of  a  moving  surface  in  point  contact 


Consider  an  instantaneous  contact  at  points  Pm  and  Pf  as  shown  in  Fig.  3.2. 
We  call  this  configuration  the  reference  (or  zero)  position,  and  use  Pm  and  Pj 
as  the  origins  of  moving  and  fixed  coordinate  systems.  In  the  reference  (or  zero) 
position,  the  xm  and  ym  axes  are  coincident  with  the  x and  yf  axes  respectively 
and  they  are  in  the  common  tangent  plane  to  the  two  surfaces.  The  zm  and  zf 
axes  are  along  the  common  normals  and  point  in  toward  the  moving  surface  (Fig. 
3.2).  As  the  motion  proceeds  the  moving  body  rotates  to  a  general  orientation 
where  the  geometry  is  as  shown  in  Fig.  3.1. 
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The  moving  surface  with  respect  to  the  moving  frame  is  represented  by 

~m  2/m)* 

The  fixed  surface  with  respect  to  the  fixed  frame  is  represented  by 

By  definition,  at  the  reference  (or  zero)  position, 

%  m  y  m  —  ^  m  ^  m ,  y  fij 

*,  =  y/  =  A/  =  A,,x  =  */,y  =  0 
We  have  adopted  the  following  convention 


")  ^m,iy  — 


dxmdy„ 


hm  xx,  hrn  yy  and  higher  order  derivatives  are  similarly  defined.  The  same  nota¬ 
tions  extend  to  hf  when  we  substitute  m  for  /  in  the  above  expressions.  To 
simplify  the  matter,  we  shall  use  /i;,z,  and  y,,  where  the  subscript  t  indicates 
that  either  m  ox  f  can  be  substituted  for  i.  (However,  the  same  meaning  of  t 
must  be  used  throughout  the  entire  equation.)  Also,  if  i  is  used  as  a  superscript 
we  use  the  convention  (  —  1)*  =  —1  when  i  =  m  and  (  —  1)'  =  1  when  i  =  f. 

We  imagine  that  the  surface  i  has  two  families  of  curves  which  are  parallel  to 
the  x,-z,  plane  and  y,-z,  plane  respectively.  Let  ktI  and  k,  y  denote  the  planar 
curvatures  at  a  general  point  of  the  two  families  of  curves,  respectively,  these  are 
written  as  k,  x  and  k,  y  at  Pm  and  Pj.  Let  g,  =  h,xy  so  that  g,  is  a  measure  of  the 
parallelism  of  tangents  to  one  family  of  curves  at  the  reference  position.  For  a 
surface,  k,  x  and  ki  y  characterize  its  symmetric  bending  and  the  g,  characterize 


We  have  assumed  explicit  analytic  forms  of  the  moving  and  fixed  surfaces  with 
respect  to  the  corresponding  reference  frames.  In  the  following  development, 
however,  only  the  partial  derivatives  of  these  forms  are  used,  and  in  Appendix 
C  we  have  shown  that  these  partial  derivatives  can  always  be  explicitly  obtained 
from  any  analytic  representation  of  a  surface. 
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its  anti-symmetric  bending  about  the  tangential  axes.  We  define  klIX  to  be  the 
rate  of  change  with  respect  to  x,  for  ktx  and  k,  xy  to  be  the  rate  of  change  with 
respect  to  y;  for  ki  x  at  the  reference  points.  Similarly,  we  define  k,yx  to  be  the 
rate  of  change  with  respect  to  x ,  of  k,  y  and  ktyy  to  be  the  rate  of  change  with 
respect  to  y,  of  k,  y  at  the  reference  points.  All  these  quantities  are  simply  related 
to  the  partial  derivatives  of  li,  (see  Appendix  D),  and  will  be  used  throughout 
this  chapter. 

Constraints  on  the  surface  normal  at  contact 

At  every  point  on  the  moving  surface  the  inwardly  directed  unit  normal  is 


and  at  every  point  on  the  fixed  surface  the  outwardly  directed  unit  normal  is 


Let  and  ym  in  hm  be  the  time  varying  coordinates  of  Qm,  and  x f  and  yf  in 
hf  be  the  time  varying  coordinates  of  Qf.  At  each  instant  the  inwardly  directed 
normal  of  the  moving  surface  and  the  outwardly  directed  normal  of  the  fixed 
surface,  at  the  current  point  of  contact,  must  coincide.  Thus 

Nf(t)  =  R{t)Nm(t ),  (1.6) 

where  R(t)  is  the  3x3  matrix  which  transforms  the  coordinates  of  the  moving 
system  to  their  values  in  the  fixed  system. 

Since  (6)  is  valid  for  the  entire  motion,  its  nth  order  time  derivatives  can  be 
written  as 

!>,(,)  =  £wo*.<01.  <«•') 

We  define  fl  =  [w, ,  u2)  ^s]r,  the  angular  veloctity  vector,  and  £  =  dfl/dt  = 
[<i,  fj]T,  the  angular  acceleration  vector.  The  derivatives  of  R  have  been 
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Figure  3.3  Contact  trajectories  on  surfaces 

analyzed  by  many  authors,  for  example  see  p.  22  of  [Bottema  and  Roth,  ’79], 
At  our  reference  position,  /2(0)  is  an  arti-symmetric  angular  velocity  matrix 
and  R( 0)  is  the  sum  of  an  anti-symmetric  angular  acceleration  matrix  and  a 
symmetric  matrix.  Using  Appendix  D  (D1)-(D3),  the  first  row  of  (7)  yields  in 
the  initial  position,  for  n  =  1 

kf,xit  +9,y,  =  -  9mifm  +  “>2,  (1.8) 

and  for  n  =  2 


El*  i  t  "b  2&,iXyX,y(  T  b  b  ~b  ~b  “I” 


(1.9) 


While  the  second  row  yields  in  the  initial  position,  for  n  =  1 


9/X  f  ~b  k f,y9f  9 mx  m  k rn^Vm  ^1  j 


(1.10) 


and  for  n  =  2 

(i.)2  +  2 k,:VXxxy,  +  klvyy]  -b  g,x ,  +  k,yy,}  = 

I 

-  2u>s{kmfZxrn  +  g^ym)  +  w2w3  -  t, . 


(1.11) 


The  third  row  of  (7)  is  dependent  on  (8)  and  (10)  for  n  =  1,  and  (9)  and  (11) 
for  n  =  2. 
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We  have  used  the  notation,  dnVi/dtn  =  v\  ,  dnv2/dtn  =  v2  '  and  dnvi/dtn  = 
o3n).  V  is  the  rate  of  change  of  both  the  sliding  speed  and  its  orientation,  we 
call  it  the  sliding  acceleration.  For  pure  rolling,  up  to  the  ntK  order,  V  =  V  = 

_  y(  n-I)  _  o 

To  simplify  the  expressions  in  the  following  we  explicitly  express  (from  the  deriva¬ 
tives  of  (1.1)  and  (1.2)) 


z;  -  (-l)’+,(£,,Ii*  +  2g,x,y,  -I-  ki<yy\), 

z[3)  -  (- 1),+1  +  3(k,  xyx,  +  k,iyxy,)x,y,  +  k,  yyy f 

+  3(k, Xx,x,  +  k.^y^i  +  gt{x,y,  +  t/.i,))]. 


(1.19) 


(1.20) 


We  take  the  first  three  derivatives  of  (15)  and  substitute  (17),  the  first  row  of 
each  derivative  can  be  written  as,  respectively, 


t,  =  v,  +  im, 


i,  =vi+i.m  -  ymu>3, 


(1.21) 


(1.22) 


x(3)  =  «1  +  Zm’  +  *m(-w 2  -  w, )  -  2 j/mw,  +  j/m(w ,  U>2  -  ( 3)  +  2 ZtnU)2\  (123) 


the  second  rows  yield 


V,  =v  2  +  ym> 
y,  =  v  2  +  3  +  y  m  1 


(1.21) 


(1.25) 


y(3)  =  i>2  +  2imu/s  -f  xm(u)iUJ2  +  (j )  +  +  ym(-^f  “  “-a)  ~  2irmw,;  (1.26) 


the  third  rows  yield 


=  0, 


vs  =  z,  ~  L  +  imw2  -  jfmw, , 


(1.27) 


(1.28) 


WjS)  =  ^3)  -  ^  +  2zmu>2  -  im(w,w3  -  t2)  -  2 ymw,  -  ym( w2ws  +  r,).  (1.29) 
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Constraints  on  the  moving  point 

Let  the  position  vector  for  the  moving  point 

e,„=(A 


We  substitute  n  =  0, 1  and  2  into  (17).  The  first  rows  of  the  resulting  matrix 
equations  yield 


pz  =  v  i  , 


(1.30) 


Pt  =  fl  +J/n>Wj, 


(1.31) 


pL3)  =  +  2xm(^  +  w’)  +  yma>3  -  2 jrm(a>,w2  -  e3)  -  zmu2\ 


(1.32) 


the  second  rows  yield 


P  y  = 


Py  ~~  ^2  ^rnw3) 


(1.33) 


(1  34) 


p[3)  =  V2  -  3  ~  2im(u;1u;2  +  c3)  +  2ym(u>*  +  a/,)  +  zm w, ; 


(1  35) 


the  third  rows  yield 


Pz  =  0, 


(1.36) 


Pz  =  z,  ~  zm  +  2(imw2  -  ymw,), 


(1.37) 


p[3)  =  z(3)  ~  ^  +  3xmw2  -  3irn(w1wJ  -  e2)  -  3ymul  -  3ym(u;2u/3  +  e,).  (1.38) 


3.2  Motion  properties  for  point  contact  between  surfaces 


From  the  basic  constraints  in  the  last  section,  we  derive  the  the  contact  trajec¬ 
tories  up  to  second  order,  and  the  moving  point’s  trajectory  up  to  third  order. 
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Figure  3.4  A  relative  surface 

First  order  properties 

A  function  Z  describes  in  the  reference  position  a  “relative  surface,”  Z  =  H(x,  y) 
=  hm(x,y)  +  hf(x,y)  (Fig.  3.4).  Similar  to  kix,k,y  and  gi  for  the  m  and  / 
surfaces,  we  have  for  this  relative  surface  at  the  reference  position 

^m,x  4~  ^J,x  l  A  y  4"  ^/(y,  C  <Jm  “f-  g  j  • 

From  these,  the  Gaussian  curvature  of  the  surface  at  the  reference  point  is  given 
by 

K  =  KzKy  -  G2. 

Kz ,  Ky,G  and  K  of  the  relative  surface  are  important  to  the  relative  motion 
between  two  surfaces,  and  will  be  used  throughout  this  chapter.  We  substitute 
(1.21)  and  (1.24)  into  (1.8)  and  (1.10),  and  solve  the  linear  equations  for  tangen¬ 
tial  contact  velocity: 

Zm=  ~[G{ux  +g,vl  +  fc/,y t'j)  -  A'v(— U>2  +  kf'tVt  4- 5,  ”2)],  (2.1) 

ym=  Jf[-Kx{ui  +gfv ,  +  k,_yv2)  +  G(-w2  +  kftXvx  +5^2)],  (2.2) 

X,  =  jr[-G{-Vi  4-  gmv ,  4-  *m,vv2)  +  Ky{ui2  -I-  km<xv 2  4-  0ra«2)],  (2.3) 

y,  =  ^[^x(-w,  4-  $mv,  +  km  yv2)  -  G(u>j  +  kmxv  1  +  pmv2)].  (2.4) 

The  contact  velocities  do  not  depend  on  u>s  ,  the  normal  component  of  the  angular 
velocity. 
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For  pure  rolling,  by  definition  vx  =  vy  =  0, 


xm  =  xt  =  —(Gw,  +  A'yw2), 


ym  =  y,  =  +  Gu>2).  (2.6) 

Assume  that  there  exists  a  tactile  sensor  at  the  contact  point  and  that  it  allows  us 
to  calculate  the  tangential  contact  velocity.  Given  the  geometry  and  the  sensor 
reading  we  can  calculate  the  tangential  angular  velocity  (u>,  and  w2),  or  vice 
versa.  It  can  be  noted  that  xt  and  y^  are  related  only  to  the  geometry  of  the 


relative  surface. 


When  u>,  in  equations  (l)-(4)  vanish,  we  have  the  relationships  for  pure  sliding. 
From  the  sensor  reading  for  the  tangential  contact  velocity  we  can  calculate  the 
tangential  sliding  velocity,  and  vice  versa. 


Second  order  properties 


Substituting  (1.22)  and  (1.25)  into  (1.9)  and  (1.11),  we  obtain  the  tangential 
contact  acceleration  for  the  general  motion, 


X m  -  t  A’a  i\)  -  y,{ilnu3  +  V2)] 

-  G[B  +  gf(  u>3ym  -  vt)  -  fc/iS,(imu>3  +  v2)]}, 


ym  =  -jr{Kx[B  +  y,(w3ym  -  »,)  -  k,<y(xmu;3  +  v2)j 
-  G[A  +  kf  x(ymu3  -vi)~  g,(xmu3  +  u2)]}, 

x,  =  -^{A'y[A  +  A:m,I(-ymws  +  u1)  +  ym(imu;s  +  u2)] 

-  G[B  +  gm{-v»ym  +  vi)  +  kmiy(xmu>3  +  u2)]}, 

y,  =  -^{AI[J9  +  ym(-Wjym  +  u1)  +  tm,v(xmw3  +  v2)] 

-  G[A  +  +fcm>I(-ym w3  +  Vi )  +  sm(imw3  +  v2)], 


(2.10) 


where 


A  —  t2  +  Wj  w3  -f-  2u>3(grnxm  +  ^  '(^i.n^i  "h  2fc,>yi,y,  ~h  k^yxy. ),  (2.11) 


w 


9 


9 


tutto".  vy  sr*  vxvx  vr  vn  i.wwLT^v^m^TM'vimw  v\  w  u^x- 
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P  ~  2uJj  (  krnxX  m  “f*^m3/m)  ^  ^*,yyUt  )*  (2.12) 

t 

For  pure  rolling  up  to  second  order,  by  definition,  the  sliding  terms  (r, ,  v2,  u,  and 
t>2)  vanish  in  equations  (7)-(12).  If  in  addition  u)a  =  0,  then 

xm  =  xr  ym  =  y,-  (2.13) 

These  accelerations  are  only  related  to  the  geometry  of  the  relative  surface.  When 
€,  =  f2  =  u}3  =  0,  then  xm  =  x,  =  ym  =  y,  =  0. 

The  tangential  angular  acceleration  and  tangential  contact  acceleration  are  in 
one-to-one  correspondence  with  each  other;  from  either  one  we  can  determine 
the  other. 

For  pure  sliding  up  to  second  order,  by  definition,  fl  and  £  vanish  in  equations 
(7)-(12),  and  we  have  relationships  between  the  tangential  contact  acceleration 
and  sliding  acceleration  which  are  in  one-to-one  correspondence  with  each  other. 

From  (131)  and  (2),  the  xf  component  of  the  acceleration  of  the  moving  point 
is 

Px  =  Vi  +  ~[~Kx(ui  +gtv !  4-  kj,yv2)  +  G(~u2  +  kfiXvl  +gf  t;2)].  (2.14) 

From  (134)  and  (1),  the  yf  component  of  the  acceleration  of  the  moving  point 
is 

py  =  v2-  ^jr[G(a>i  +gfvt  4-  kfty  v2)  -  A'y(-u>2  4-  +5^2)]-  (2-15) 

Substituting  (1.19)  into  (1.37),  the  zf  component  of  the  acceleration  of  the  mov¬ 
ing  point  is 

P,  =  -  y^jk.^x7,  4-  2g,x,y,  4-  *;,vy?)  4-  2(w2xm  -  uxym),  (2.16) 

I 

where  x,  and  y<  are  from  (l)-(4).  For  the  moving  point,  the  normal  acceleration 
is  completely  independent  of  u>3,  and  the  tangential  acceleration  is  equal  to  the 
tangential  sliding  acceleration  when  ws  =  0. 
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For  pure  rolling  up  to  second  order, 


uj s 

Px  =  -  — (A'*a/,  +  Gw2), 


Py  =  +  Cw,)f 


Pi  —  t:(AuWj  +  hxu)f  +  2  Gu)lu!2)- 

ft 


(2.17) 


(2.18) 


(2.19) 


The  acceleration  of  the  moving  point  depends  only  on  the  geometry  of  the  relative 
surface  and  the  angular  velocity. 

If  we  define  the  coordinate  frame  such  that  yf=0  (we  are  free  to  choose  the  ori¬ 
entation  of  the  reference  frame  about  the  contact  normal),  then  =  —Gu>2/Kx, 


P*  =  0, 


Py  =  — 


(2.20) 


(2.21) 


Unlike  rolling  with  point  contact  between  two  planar  curves,  for  spatial  pure 
rolling  if  the  tangential  and  normal  angular  velocities  do  not  vanish,  there  exists 
tangential  acceleration,  and  its  direction  is  perpendicular  to  that  of  the  contact 
velocity  with  respect  to  the  fixed  surface. 


rn-x!  (jl>2 


Vy  . 


Figure  3.5  Moving  point’s  acceleration  under  pure  rolling 
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With  this  special  reference  frame,  jpz  takes  the  simplified  form 


Wj 

P‘  =  T,= 


+  k 


/.* 


(2.22) 


where  kmx  and  kfs  are  the  curvatures  of  the  curves  cut  from  the  surfaces  by  a 
plane  through  the  surface  normal  and  the  tangent  to  the  contact  velocity  with 
respect  to  the  fixed  surface,  and  u>2  is  the  tangential  angular  velocity  component 
perpendicular  to  this  plane  (Fig.  3.5).  This  formula  resembles  the  analogous  one 
for  two  planar  curves  in  pure  rolling  contact.  No  matter  what  contact  trajectories 
are  traced  by  Q{  on  the  fixed  surface,  when  the  angular  velocity  and  the  path 
tangent  are  the  same,  the  normal  acceleration  of  the  moving  point  must  be  the 
same. 


For  the  moving  point,  the  ratio  of  the  magnitude  of  the  tangential  acceleration 
to  the  normal  acceleration  is  equal  to  This  is  the  ratio  of  the  angular 

velocity’s  normal  compor  :nt  and  its  tangential  component  which  is  perpendicular 
to  the  contact  velocity  with  respect  to  the  fixed  surface. 


From  ( 1 4)-(  1 6),  for  pure  sliding  the  tangential  components  of  the  acceleration  of 
the  moving  point  are 

P*  =  v  i,  (2.23) 

Py  =  v?-  (2.24) 

The  general  expression  for  the  normal  acceleration  of  the  moving  point  when  the 
relative  motion  between  surfaces  is  pure  sliding  can  be  obtained  by  substituting 
(l)-(4)  into  (11),  and  setting  the  angular  velocity  to  zero.  If  both  surfaces  in 
contact  are  symmetric,  gm  =  gf  —  0,  and  if  we  define  the  reference  frame  such 

that  v2  =  0  (also  yf  =  0  from  (4)),  and  =  v  (u  is  the  sliding  speed)  then 


TPz  = 


(2.25) 


Pm, x  =  1  /km,x  and  pfiX  =  1  /kf<x  are  the  radii  of  curvature  of  the  curves  cut 
from  the  surfaces  by  a  plane  through  the  motion  tangent  and  the  contact  normal 
(Fig. 3. 6). 
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Figure  3.6  Moving  point’s  acceleration  under  pure  sliding 

This  formula  resembles  the  one  for  point  contact  between  two  planar  curves  when 
the  relative  motion  is  a  translation. 

Third  order  properties 

Substituting  (1.19)  into  (1.32),  we  have  the  xf  component  of  the  jerk  of  the 
moving  point 

Pls)  =  vl+2xm(wl+vl)+ymW3-2i/m(u;lu>2-Ci)-(kmtXx2m+2grnzmym+kTnilly2m)u>2 

(2.26) 

Substituting  (1.19)  into  (1.35),  we  have  the  yf  component  of  the  jerk  of  the 
moving  point 

P(ys)  =  V2+2ytn(u*+ul)-xmU3-2xm(Ljlu>2+t3)+{kmtXx2l+2grnxmyrn+km'j/y2rn)ujl 

(2.27) 

Substituting  (1-20)  into  (1.38),  we  have  the  zf  component  of  the  jerk  of  the 
moving  point 

p[3)  =  -  +  3(fc,iiyXj  +  fc,iyxy,)i.y,  +  fc,,yyy?  4-  3(fc,  Ii,i,  +  kKy y,y,+ 

i 

9i(x,yi  +  y<i.))]  +  3imu>2  -  3im(w1  w3  -  e2)  -  3ymu>,  -  3ym(u)2us  +  e , ) 

(2.28) 

where  z„  yl}  xt  and  yv  have  already  been  calculated  earlier  in  this  section. 

For  pure  rolling,  up  to  third  order,  by  definition  =  0  for  k  =  0, 1  to  3. 

We  can  substitute  these  into  (26)-(28)  and  also  the  values  from  the  previously 
derived  x,,  y„  x,  and  y,  for  pure  rolling  up  to  second  order. 
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For  pure  sliding  up  to  second  order,  by  definition,  Q 
expressions  (26)-(28)  take  the  simplified  forms 


pi3)  = 


P(3)  =  i’2, 


=  0  and  £  =  0.  The 


(2.29) 


(2.30) 


p[3)  =  -  +  3(**.*v**  +  k.,s,.ry.)i.y.  + 


.  (2.31) 

+  3  (k,iXx,xt  +  ktyyty,  -f  g,{x,y,  +  y, £,))], 

where  the  previously  derived  values  of  i,,  y,,  x ,  and  y,,  for  a  pure  sliding  motion 
will  be  substituted. 

For  pure  rolling  up  to  nth  order,  assuming  all  derivatives  of  the  angular  velocity 
up  to  (n  —  2)th  order  are  known,  there  is  a  one-to-one  correspondence  between  the 
tangential  (n  —  l),h  derivatives  of  contact  velocity  and  angular  velocity.  Similarly, 
for  pure  sliding  up  to  nih  order,  when  given  the  derivatives  of  the  sliding  velocity 
up  to  (n  — 2)"*  order,  there  is  a  one-to-one  correspondence  between  the  tangential 
(n  —  l)‘h  order  derivatives  of  the  contact  velocity  and  the  sliding  velocity. 

3.3  Spatial  motion  with  point  contact  between  two  spheres 


As  an  example  to  illustrate  the  general  relationships  developed  in  the  last  section, 
we  consider  spatial  motion  with  point  contact  between  two  spheres  of  radii  pm 
and  pj. 

The  /im  and  hf  defined  in  (1.1)  and  (1.2)  can  be  explicitly  written  as 

—  rt  _  .  f  Z  it 2  Z  _  —  n  .  —  —  t«2  —  ..2  ( ‘X  1  \ 


hm  ~  Pm  ~  VP2m  ~  *™  ~  Vln  >  kf  =  Pi  ~  \J Pf  ~  X)  ~  P) 
Substituting  (1)  into  Appendix  D  (Dl)  and  (D3),  we  have 

^m,x  —  m, y  *1  l/.I  1  !’/,»  9 m  Pj 

Pm  P ) 

Substituting  (1)  into  Appendix  D  (D2),  we  have 


h,,IX  k,  ly  k,  yx  —  k,  yy  0. 
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To  simplify  the  following  expressions,  we  define 


Pm  Pi 
Pm  +  P) 


P,~Pm  +  Pi- 


Substituting  (2)  and  (3)  into  (2.1  )-(2.4),  we  have  the  expressions  for  the  tangen¬ 
tial  contact  velocities, 


xm  =  p(v2  -  —),  y m  =  -  — ), 

Pi  Pi 

x  =p{u>2  +  —),  y  =p(-w,  +  — ). 

Pm  Pm 


(3.4) 

(3.5) 


For  pure  rolling,  the  contact  velocity  (i,  and  y,)  is  sensitive  to  the  radii  of  the 
spheres.  When  one  sphere  is  small,  p  will  be  small,  and  the  contact  velocity 
(sensed  by  a  tactile  sensor)  will  be  less  sensitive  to  the  sliding  velocity  (t>,).  If 
one  sphere’s  radius  increases  to  infinity  it  becomes  a  plane,  in  which  case  the 
contact  speed  is  proportional  to  the  radius  of  the  remaining  sphere. 


For  pure  sliding, 


i  +  pi!p< 


-Vl,  2/m  = 


f  +  p  i!  P' 


-w, 


(3.G) 

(3.7) 


1  1 

X,  =  - ; - 1>1  ,  y,  =  - ; - t'2. 

1  +  Pm/ Pf  1  +  Pm/ Pi 

When  one  sphere  is  very  small  in  radius  compared  to  the  other  sphere,  a  tactile 
sensor  on  it  will  have  poor  sensitivity  for  measuring  the  sliding  velocity. 


Substituting  (2)-(5)  into  (2.7)-(2.12),  we  'nave  expressions  for  the  tangential  con¬ 
tact  acceleration. 


Xm  =  P[( 2  +  W,U),  - 

jim  =  P[~(  1  +  - 


2/5/  +  Pr 


P, 

2Pf  +  Pr 


Pr 

Pi. 


v~)- 

5-1. 

(3.8) 

Pi 

Pi 

ft- 

-H 

(3.9) 

Pi 

Pi 

x  ,  —  p\(2  +  UWj  —  —  w3(u/,  -i - )  -I - U 


(3.10) 
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y  =  p[— € i  +  u;2ws - -uj3(u>2 - )  H - ]•  (311) 

P»  Pf  Pm 

When  i>,  and  i),  in  (8)-(ll)  vanish,  we  have  the  tangential  contact  acceleration 
for  pure  rolling  up  to  second  order.  Its  sensitivity  to  the  angular  acceleration 
depends  on  the  radii  of  the  spheres  in  a  similar  way  to  that  discussed  earlier  in 
this  section  for  the  angular  velocity. 

When  w,  and  <r,  vanish  in  (8)-(ll),  we  have  relationships  between  the  tangential 
contact  acceleration  and  sliding  acceleration,  which  are  exactly  the  same  as  those 
between  tangential  contact  velocity  and  sliding  velocity. 

Substituting  (2)-(5)  into  (2.14)-(2.16),  we  have  the  acceleration  of  the  moving 
point, 


Px  =  p(-w ,  -  —  )w3  +  Vl, 

(3.12) 

Pf 

Py  =  P(-U>2  +  —  )W3  +  V2, 

Pf 

(313) 

,,  r?  +  v%  2  pm 

+  )  +  (u^j  V2  W2U]). 

(3.14) 

For  pure  rolling, 

jpx  =  -pulsus,  Py  =  -pw2v3,  pc  =  p(ut2  +  w22).  (3.15) 

The  normal  acceleration  is  proportional  to  the  square  of  the  magnitude  of  the 
tangential  angular  velocity,  and  the  ratio  of  the  magnitude  of  the  tangential 
acceleration  to  normal  acceleration  is 

v /i>i  +  pI  =  M 

Pi  +  W2 


We  can  easily  calculate  the  acceleration  of  the  center  point  of  the  moving  sphere 
under  pure  rolling.  When  f,  =  f2  =  0,  the  acceleration  at  the  center  point  has  the 
magnitude  ratio  p^/Pf,  and  is  along  the  opposite  direction  to  the  acceleration 
of  the  moving  contact  point. 
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For  pure  sliding,  up  to  second  order, 


Px  =  pv  =  v2,  p,  =  -■ 


w?  +  vl 


Ps 


(3.16) 


The  normal  acceleration  is  inversely  proportional  to  the  sum  of  the  radii  of  the 
spheres,  and  proportional  to  the  square  of  the  sliding  velocity. 


Substituting  (2)-(5)  and  (8)-(  11)  into  (2.26)-(2.28),  we  have  expressions  for  the 
components  of  the  jerk  of  the  moving  point: 


p(c3)  —  i)]  +  2 p(w2 - )(ul  4-  a-',)  4-  poi3[— 4-  u2u! 3 - — - - — u>3( u2 - -) 

P J  Ps  Ps 


— — ]  4-  2p(ulu2  —  c3)(u;1  4-  — ) - ^2(^1  4-  4 — j(t>j  4-  v\) 

Pj  Pj  Pm  Pf 


4-  — (lo,v2  -  w2u,)], 
Pf 


(3)  Ojs/V.  L  M.  ,2  1  ,  ,2\  \r  1  2Pf  +  Pm  ,  ,  v2 


(3.17) 


Py  =V7  -  2 p(w,  4 - )(wj  4-  u>l)  -  pu)3[c2  4 

Pj 


^3(^1  4 - ) 

Ps  Pj 


"  1 —  2  1 

-  — ]  -  2p(w1w2  4-  e3)(w2  -  — )  4  — u>,[cc?  4  w2  4  —  (wf  4-  v2) 
P/  P/  Pm  P) 


4 - (w,v2  -  w3t'i)], 

P/ 


(3.18) 


(31  Vlt>2  4-t>2t>,  ,  _f  ,  ,  P  , 

Px  = - l-p^C!  4-w2(2J - w3(t;,w,  4t;2u>2) 

Ps  Ps 


4-  3p{  —  (oj[W3  —  f2)(w2  —  — )  4  (w2w3  4  fi)(w[  4 - 

P/  Ps 


v2 


4  u>2[e2  4  u),oj3 - -~--——u>3(u,  4 - -)  -  — ] 

Ps  Pj  Pj 


(3.19) 


r  j  ^P/  4  Pm  1  ^1  \  1 1 

—  [  —  Cl  4  U2U>3 - W3(u)2 - ) - J  }. 

Ps  Pf  Pf 


For  pure  rolling  up  to  third  order, 


p{P  =p[2w2(w2  4u;,)  4ws[-(, 
- —u2{u\  4  w2)}, 


—  w2w3]  4  2 wi(w1w2  —  r3) 

Ps 


(3.20) 
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(u>f  -f  Wj)  +  w3[e2  —  —u>tuj3]  -f-  2a>2(wiU>2  +  <a) 
Ps 

- — w,(wf  +  Wj)}, 

Pm 

p[s)  =  3  p(u)lel  +  u>2f2). 


(3.21) 

(3.22) 


When  o-s  =  e3  =  0,  p(vs)/p*s)  =  —a /,/u>2.  In  words,  when  the  normal  angular 
velocity  and  the  normal  angular  acceleration  vanish,  the  ratio  of  the  two  perpen¬ 
dicular  components  of  the  tangential  jerk  (of  the  moving  point)  is  equal  to  the 
inverse  of  the  ratio  of  angular  velocity  components  along  the  same  axes. 


When  ( i  =  <f2  =  0,  pis)  =  '  the  normal  jerk  of  the  moving  point  vanishes 

when  there  is  no  tangential  angular  acceleration. 


For  pure  sliding, 

pi3)-v,.  P(*)  =  v7l  p[i)  =  -  —  (v iVi+i'2v3)  (3.23) 

P, 

The  normal  jerk  of  the  moving  point  is  inversely  proportional  to  the  sum  of  the 
radii  of  the  spheres  and  linearly  proportional  to  the  sliding  velocity  and  sliding 
acceleration.  When  either  the  tangential  sliding  velocity  or  sliding  acceleration 
vanishes,  the  normal  jerk  of  the  moving  point  vanishes. 


3.4  Special  geometry  of  contacting  surfaces 

We  can  extend  our  general  relationships  to  the  special  cases  where  one  contact 
surface  is  a  sharp  vertex  (a  point),  or  a  sharp  edge  (a  line)  or  a  plane  (Fig.  3.7). 
We  model  a  point  and  a  plane  as  the  limit  of  a  sphere,  and  a  line  as  the  limit  of 
a  circular  cylinder. 

Moving  surface  is  a  point 

When  the  moving  surface  is  modeled  as  the  decreasing  limit  of  a  sphere,  km  i 
and  km  y  approach  oo;  gm  ,  km  xI,  fcm  ry,  km and  kmyy  vanish.  By  taking 
the  limit  in  (2. 1  )-(2.4)  and  (2.7)-(2.l0)  (after  substituting  in  (2.11)  and(2.12)), 


y 
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Figure  3.7  Special  geometries  for  point  contact  between  surfaces 


the  tangential  contact  velocity  and  the  contact  acceleration  with  respect  to  the 
moving  frame  arc  respectively, 


Xm  =  J/m  =  0,  im  =  j/m  =  0. 


(4.1) 


Obviously  the  contact  trajectory  with  respect  to  the  moving  frame  reduces  to  a 
point. 


The  tangential  contact  velocity  and  acceleration  with  respect  to  the  fixed  surface 
are,  respectively, 

*,=«,•  y,  =  (4.2) 

X,  =  «1,  y,  ~  V 2.  (4.3) 

The  tangential  contact  velocity  and  acceleration  with  respect  to  the  fixed  surface 
are  equal  to  the  tangential  sliding  velocity  and  acceleration.  Substituting  (1) 


9 


31 


1 
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into  (1.17),  we  see  that  they  are  also  equal  to  the  tangential  acceleration  of  the 
moving  point.  By  taking  the  limit  in  (2.16),  one  obtains  the  normal  acceleration 
of  the  moving  point, 


P,  =  -(*/.xt>?  -f  2gf  v,  v2  +  kf,yv\). 


(4.4) 


Fixed  surface  is  a  point 

When  the  fixed  surface  is  modeled  as  the  decreasing  limit  of  a  sphere,  kfx  and 
kfy  approach  oo,  g} ,  kjXX)  k{xy ,  kfyX  and  kfiUy  vanish.  By  taking  the  limit  in 
(2.1)-(2.4)  and  (2.7)-(2.10),  the  tangential  contact  velocity  and  acceleration  with 
respect  to  the  moving  frame  are,  respectively, 

xm  =  -v1  ,  ym  =  -v2,  (4.5) 

Xm  =  “t>i  -  U>3V2,  tim  =  ~V2  +  WjU,  .  (4.6) 


The  tangential  contact  velocity  and  acceleration  with  respect  to  the  fixed  frame 
are,  respectively, 

i,  =  y,  =  °>  (4-7) 

it~y,=  °-  (4-8) 


Taking  the  limit  in  (2. 14)-(2. 1 6),  the  components  for  the  acceleration  of  the 
moving  point  are,  respectively, 


px  =  Vi  -  usv2,  (4.9) 

Py  =  V  2-W,V,,  (4.10) 

Pr  =  -(fcm.xU?  +  2gmvxv2  +  fcm,yVj)  +  2(-w2v,  +  u;,t>2).  (4.11) 


Comparing  (11)  to  (3.9),  when  either  surface  in  contact  is  reduced  to  a  point, 
the  sliding  velocity  becomes  the  dominant  term  in  the  expression  for  the  normal 
acceleration  of  the  moving  point,  which  is  not  the  case  for  convex  surfaces  (for 


A.  -I  - 
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our  purposes,  we  have  convex  surfaces  when  Pm  and  Pf  are  elliptic  points  of 
their  surfaces,  and  locally  the  surfaces  are  bent  away  from  the  tangent  plane  in 
different  directions). 

Moving  surface  is  a  line 

When  the  moving  line  is  modeled  as  the  decreasing  limit  of  a  circular  cylinder 
with  its  direction  coincident  with  the  x  axis  (by  virtue  of  the  choice  of  the  ori¬ 
entation  of  the  reference  frames  about  the  contact  normal),  kmy  approaches  oo, 
and  km,x,  gm,  kmxx,  kmyx  and  kmyy  vanish. 


Taking  the  limit  in  (2.1)  and  (2.2), 

*m  =  -7~—  (~u2  +  +0/v2),  ym  =  0. 

kj,x 

Taking  the  limit  in  (2.7)  and  (2.8), 

im  =~ -  {<4  4-  +  2-^-[-fc/iX(w,  4-  kfyv2)+gf{-uj2  +  g}v2)] 

*/,* 

-( kf,xxx *  +  2kj  Xyxfyf  H-  kfiyxy2f)  —  kfiXvx  -  g,  (imw3  +  t>2)} 

ym  =  0. 


(4.12) 


(4.13) 


(4.14) 


Obviously,  the  contact  trajectory  with  respect  to  the  moving  frame  is  a  point 
along  the  ym  direction,  and  it  is  a  general  function  of  the  motion  along  the 
direction. 


Taking  the  limit  in  (2.3)  and  (2.4), 

i,  =  -r—  (w2  -  gfv7),  yf  ~  v2. 

* /,x 

Taking  the  limit  in  (2.9)  and  (2.10), 

X.  =T—  {e2  +w,u>3  4-  T^-(-*/,x(w,  4-  kf  yv2)  +gj{-u2  +gfv2)\ 

Kf.x  kf,x 

-(*/.  xxi)  4  2kjxyxf  yf  4  kjiyxy ^)  gj(xmuj3  4  u2)), 
yf  =  i2  +  xmu3. 


(4.15) 


(4.16) 


(4.17) 


*v»i \ *Jb *.f| »  |»*. **•  J 
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From  the  tangential  contact  velocity  with  respect  to  the  fixed  frame,  we  can 
uniquely  determine  the  components  of  the  angular  velocity  and  sliding  velocity 
along  the  yf  direction,  and  from  the  tangential  contact  acceleration  with  respect 
to  the  fixed  frame,  we  can  determine  the  components  of  the  angular  acceleration 
and  sliding  acceleration  along  the  yt  direction. 


Taking  the  limit  in  (2.14)-(2.16),  we  have 


P*  =  > 


Py  =  +  7 - (~w2  +  1  +  QfV7), 

Kf.x 

p.  =  P-  +  (P-  -  kj.M  -  2^(v,  + 


(4.18) 

(4.19) 


(4.20) 


In  the  x  direction,  this  result  resembles  the  case  of  pure  sliding. 

Fixed  surface  is  a  line 

When  the  fixed  surface  is  modeled  as  the  decreasing  limit  of  a  circular  cylinder 
with  its  axis  parallel  to  the  x  axis,  kjtV  approaches  oo,  and  kjx,  gj,  k Jxx,  k}xy, 
kf  yi  and  kf  yy  vanish.  By  taking  the  limit  in  (2.1)  and  (2.2), 


im  =  T — (Wz  +  gmv2),  ym  =  ~v2- 

",m,x 


(4.21) 


By  taking  the  limit  in  (2.7)  and  (2.8), 


im  =  7 - [f2  +  WiWj  4-  2  W3{gmim  +  kmtyym) 


4“  2krTtJ.yXrnyrn  4"  &m,yx3/m)  4“  4”  V2  ) ) 

ym  =  4-  v2). 


(4.22) 


(4.23) 


As  in  the  previous  case,  the  tangential  contact  velocity  with  respect  to  the  moving 
frame  is  completely  determined  by  the  yf  components  of  the  angular  velocity  and 
sliding  velocity.  When  all  the  velocity  terms  are  given,  the  tangential  contact 
acceleration  with  respect  to  the  moving  frame  is  completely  determined  by  the 
y  component  of  the  angular  acceleration  and  the  sliding  acceleration. 


£ 
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Taking  the  limit  in  (2.3)  and  (2.4), 

it  =  (w2  +  fcm.^1  +  gmv2),  y,  =  0. 

A'm.x 

and  taking  the  limit  in  (2.9)  and  (2.10), 

® f  — 7  [^2  4”  OJ\UJ^  4"  2u^j(^f mXm  4~  ^m,y2/m)  (^m,ii^m  4"  2fcmxy£  mt/r 

"'m.x 

4“  ^rn,yx  y2m)  +  fcm,.(-jmW 3  +  U,  )  +  5m(im^3  +  t>2)]- 

»,=°- 


(4.24) 


(4.25) 


(4.26) 


Obviously,  the  contact  trajectory  with  respect  to  the  fixed  frame  is  a  point  along 
the  yf  direction. 


By  taking  the  limit  in  (2.14)-(2.1G), 


px~vx-  w,t»2> 


U/3 

Py  =  V?-  T - \9mV 2  ~  (~U>2  +  */,*«!  +  0/V2)], 


(4.27) 

(4.28) 


1  go; 

-(7 (v2+gmV2)2-2-j^L-(u;2+ffmv2)v2  +  krnfyV2]  +  ~-(u;2+gmv2)  +  2u;l  v2 

*m,x  ^m,x  **m,x 

(4.29) 


Moving  surface  is  a  plane 

When  the  moving  surface  is  modeled  as  the  increasing  limit  of  a  sphere,  km  x, 
km, y,  g m  ,  km, xx,  km  xy,  &m, yx  and  km,yy  vanish.  We  denote  the  Gaussian  curvature 
of  the  fixed  surface  at  the  reference  point  as  A'/, 

Kf  =  kfxkf  y  —  g2- 

Taking  the  limit  in  (2.1),  (2.2),  (2.7)  and  (2.8),  the  contact  velocity  and  acceler¬ 
ation  with  respect  to  the  moving  frame  are,  respectively, 

im  =  -r~[0,v i  +*/. y“i]  ~vu  ym=  -4[, kf ,,w,  +g  u7)  -  v7,  (4.30) 

A/  K, 


\ 

A 

& 
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xm  2  +  u>iWa  (kfiXXZj  +  2kjxyxfyf  4-  kfyxy^)\ 

4*  Qf  [fl  —  U)2U>3  +  {kf'iyXj  4"  ^kf,yXX  I  y,  +  k  )]  }  —  ^1  ~k  !/mw  3) 


(4.31) 


ym  —  ~tt~  {k/,x[ti  ~  ^2U3  4"  {kfiX  yx  4-  2kjtyXxfyf  4-  kf,yyy  )] 

hf  (4 

4“  9 f  1^2  4*  —  (kf'XXx t  4  2 kf  Xyij  yf  4  kfyxy ? )]}  —  ^2  xmu>3. 

All  these  quantities  are  functions  of  both  the  rotational  and  sliding  motion. 


(4.32) 


Taking  the  limit  in  (2.3),  (2.4),  (2.9)  and  (2.10),  the  contact  velocity  and  accel¬ 
eration  with  respect  to  the  fixed  frame  are,  respectively, 


i,  =  -TT-b.w  1  +  k,y w2],  y  =  — [fc/,,w,  4  g  u 2], 
hI  KJ 

it  =  ~jr~{kj,y[(- 2  4-  Wiu;3  —  (kj  xxx ?  +  2kf,xyxl  y f  4-  kf  vxy ^ )] 
4-  gf  [f  1  -  u2u3  4  ( kf 

yx iS  ~  f  4"  2kfyXxfyf  4-  kjyyy^ )]}, 


(4.33) 


(4.34) 


y,  =-^{kj,x[*  1  -  W2W,  4-  (kj,xVx7  4-  2kf  yXxtyt  +  k/tmy3)] 

(4.35) 

+  gf[t7  4-u>,u>3  -  {k},xxx2f  +2kftXyxtyt  4- fc/.^yj)]}. 

These  are  functions  only  of  the  rotational  motion.  In  other  words,  when  there  is 
a  tactile  sensor  on  the  fixed  surface,  from  the  tangential  contact  velocity  reading, 
we  can  calculate  the  tangential  angular  velocity.  Having  knowledge  of  the  first 
order  motion,  from  the  tangential  contact  acceleration,  we  can  calculate  the 
tangential  angular  acceleration. 

Taking  the  limit  in  (2.14)-(2.16),  the  acceleration  components  of  the  moving 
point  with  respect  to  the  reference  frame  are,  respectively, 

Px  =  v,  -  ^7-(kj,x 4-  g,u2)  -  n2w3,  (4.36) 

A/ 

Py  =  V2  +  —(kf, VU)2  -  g  u,)  +  tWs,  (4.37) 

Kf 

Pi  —  Tr(^/,iW]  4"  2 gtW\W2  4  kf,yui\)  -I-  2(u;1u2  —  w2wi  )•  (4.38) 
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Fixed  surface  is  a  plane 


When  the  fixed  surface  is  modeled  as  the  increasing  limit  of  a  sphere,  kj  x ,  kty, 
9,i  kf  IX,  kj  xy,  kf  yx  and  kj  yy  vanish.  We  denote  the  Gaussian  curvature  of  the 
moving  surface  as  Km\ 


r/  _  L  L  _  _2 

m  ^m,x^m,y  9m‘ 


Taking  the  limit  in  (2.1),  (2.2),  (2.7)  and  (2.8),  the  contact  velocity  and  acceler¬ 
ation  with  respect  to  the  moving  frame  are,  respectively, 


% m  , .  [*7m^I  T  2 It 


-j-r-[km,xUi  +SmW2], 


(4.39) 

(4.40) 


im  =-£r-{km,y[(2-u1uj3  -  (*m,«i*  +  2km<xyi  f  yt  +  fcm, „*$(*)] 

“  m 

£m[fl  +  ^2^3  +  (km,Xyi2f  +  2  k  mtyx%  j  y,  +  *mfWyJ)]}, 

2/m  ^^m,yx^  j  2/  /  ^m.yyV  j  )] 

“  m 

+  5m[<2  -w»w»  -(fcm,Ixi’  +2fcmxvi/jf/  +  fcm,yxy’)]}. 

All  these  quantities  are  functions  of  the  rotational  aspects  of  the  motion  only. 
Taking  the  limit  in  (2.3),  (2.4),  (2.9)  and  (2.10),  the  contact  velocity  and  accel- 


(4.41) 
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Py  =  f 2  -  —  (gmVl  +  km,yU>2),  (4.46) 

**  m 

Pz  =  TT -(fcm.x^?  +  25mu;1u)2  +  A:m,y^2)-  (4.47) 

^  m 

Comparing  (45)-(47)  with  (36)-(38),  we  see  that  whenever  one  contact  surface 
is  a  plane,  the  angular  velocity  becomes  a  more  dominant  part  of  the  contact 
acceleration  (as  compared  to  the  case  of  contacting  between  two  convex  surfaces). 

3.5  Planning  spatial  motion  with  point  contact 

The  independent  motion  variables  which  appear  in  the  general  relationships,  and 
their  special  cases  developed  in  the  previous  sections  can  be  determined  from  a 
preplanned  path  for  the  contact.  In  the  following  paragraphs  we  discuss  the 
calculations  needed  to  determine  the  motion  variables. 

Contact  speed  planning 

Assuming  we  know  the  desired  contact  trajectory  r(sf)  on  the  fixed  surface, 
where  sf  is  the  arc-length  variable,  then  the  derivatives  of  r(.s;)  with  respect 
to  sf  can  be  expressed  in  terms  of  the  unit  tangent  t,  principal  normal  n,  and 
bi-normal  b,  as  well  as  the  curvature  re,  its  derivative  with  respect  to  s  ,  k',  and 
the  torsion  r.  It  is  well  known  that 

r'  =  t,  r"  =  «n,  r'"  =  K'n -(- «(rb  —  «t).  (5.1) 

If  we  pick  the  x-axis  so  that  it  is  aligned  with  t,  then  the  components  t2,  t3,  n, 
and  by  vanish.  Now  if  we  know  the  desired  speed  along  the  contact  trajectory,  we 
know  sf  hence  we  have  the  time-based  derivatives  of  r(sf )  from  the  relationship 
f  =  r's  .  The  tangential  contact  velocity,  acceleration  and  jerk  are,  respectively, 

*/=*;.  V,  =  °,  (r>-2) 

=  -V  y,=KS)ni, 

x(s)  =  —  k7s3  +  s(3).  i/s)  —  s 3  (K.'n2  +  Krb7)  +  3Kn2j  s  . 


(5.3) 

(5.4) 
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One  interesting  case  is  that  of  constant  contact  speed  where  we  have  the  require¬ 
ment  sf(t)  =  5,(0),  or 

Sf  =  *<»>  =  •  ■  •  =  s<n)  =  0.  (5.5) 

Substituting  (5)  into  (3)  and  (4),  the  tangential  acceleration  and  jerk  under 
constant  contact  speed  are,  respectively, 


X,  =  0,  yf  =  KS*n2. 

(5.6) 

k2s(/3),  y{fs)  =  i3  (/c'n2  +  /crt2). 

(5.7) 

The  z t  component  of  r"  is  equal  to  —kfx.  Prom  (1)  we  can  derive 


&x  _  kx 
n3  cos  <f> ' 


(5.8) 


where  <f>  is  the  angle  between  the  principal  normal  of  the  curve  and  the  surface 
normal. 

When  the  contact  trajectory  is  a  geodesic  curve,  the  curve’s  principal  normal  is 
coincident  with  the  surface  normal,  hence  n2  =  0,  and 


y,  =  0,  y{p  =  ±s*kr.  (5.9) 

The  positive  sign  is  used  here  for  contact  between  convex  surfaces. 

If  we  instead  use  preplanning  of  the  contact  speed  with  respect  to  the  moving 
surface,  the  relationships  will  be  similar  to  the  above  except  that  we  replace  / 
by  m. 


Sliding  speed  planning  with  respect  to  the  fixed  surface 

In  practice  it  is  hard  to  specify  the  sliding  velocity  trajectory,  however,  sometimes 
we  do  have  constraints  on  the  sliding  speed,  such  as  constant  sliding  speed,  which 
can  be  combined  with  other  constraints  to  determine  the  path. 

The  magnitude  of  the  sliding  speed  with  respect  to  the  fixed  surface  is  v(t)  = 
(t'f  4-  u2  +  t>|) -•  Taking  its  derivatives  we  have  constraints  which  relate  the  two 
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tangential  components  of  the  sliding  velocity,  and  similarly  for  the  acceleration 
and  higher  derivatives. 

In  addition  to  preplanning  the  contact  path,  there  is  also  the  possibility  of  pre¬ 
planning  the  relative  rotations.  The  rotation  “path”  planned  with  respect  to  the 
fixed  frame  requires  us  to  specify  the  angular  velocity  and  angular  acceleration 
directly.  We  consider  one  interesting  case  in  the  following. 

Orientation  fixed  with  respect  to  the  contact  frame 

The  contact  frame  here  is  defined  to  have  its  x  and  z  axes  respectively  coincident 
with  the  unit  contact  velocity  tangent  t  and  the  surface  normal  n.  We  consider 
the  rate  of  change  of  the  unit  tangent.  From  the  contact  trajectory  t  =  t's;  = 
sfi cn,  and  from  the  motion  of  the  body  t  =  [0,  u3,  — u;2]r,  by  equivalence 

oj2  =  -sfKn »,  (5.10) 

u>3  =  sfKn2.  (5.11) 

We  consider  the  motion  of  the  unit  surface  normal.  Substituting  xm  and  ym  to 
be  zero  in  (1.8)  and  (1.10), 

wi  =~9f*r  (5.12) 

U2  =  kftXsf.  (5.13) 

We  equate  (10)  and  (13),  kf  x  —  —nn3,  which  is  the  same  as  (8).  For  a  geodesic 

curve,  we  have  (on  a  convex  surface) 

*/.*  =  «,  u>2  =  sfkfx,  w3  =  0.  (5.14) 

The  required  angular  acceleration  can  be  determined  in  a  similar  way.  We  first 
consider  the  acceleration  of  the  unit  tangent.  From  the  contact  trajectory, 
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and  from  the  motion  of  the  body  , 

— •  —  [  —  (u>2  +  U>j),  £3  +  “£2  4  u;,u/3]r. 

dtz 

(5.15) 
(510) 
(5.17) 


By  equivalence, 


2  2  2  2 
-Ul2  —  U)a  —  ~K  S/  , 


—  £2  +W|W3  =  (k'<T  +  sf  n)n3  +  s2Krb3, 
£3  +  ui[  w2  =  ( k's 2  +  s  f  /c)n2  +  ks2  rb7. 


We  then  consider  the  acceleration  of  the  unit  surface  normal.  Substituting  the 
null  contact  velocity  and  acceleration  with  respect  to  the  moving  frame  into  (1.9) 
and  (1.11),  we  have 


£.  =  -(  kf.xyS]  +  9}X,  +  )  +  u>2 ws,  (5-18) 

£2=  kf,xxs2  +  kf:Xxl  +9jy,  +  w,w3.  (5.19) 

From  (11)  and  (13),  (15)  is  automatically  satisfied,  and  from  (16)  and  (19),  we 
have  the  constraint 

kjxxs2  +  kffXxt  +  gjij,  -  w2u>3  =  w,w3  -  {k's2  +  sfn)n 3  -  ktsH3. 

When  the  moving  body  has  fixed  orientation  with  respect  to  the  contact  frame, 
the  angular  velocity  and  acceleration  are  functions  of  the  contact  speed  and  its 
rate  of  change  with  respect  to  the  fixed  frame. 

Motion  planning  of  a  finger’s  spatial  motion 

In  Section  2.5  we  have  given  an  example  of  the  planning  of  the  planar  motion 
of  a  two-degrees-of- freedom  finger  of  a  robot  hand.  By  using  Appendix  E,  and 
the  types  of  relative  motion  planning  explained  earlier  in  this  section,  we  can 
easily  extend  the  procedure  of  Section  2.5  to  plan  the  spatial  motion  under  point 
contact  of  a  finger  with  three  or  more  controllable  degrees  of  freedom. 
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3.6  Two  or  three  point  contacts  between  surfaces 


Except  for  the  special  motions  (pure  rolling  or  pure  sliding),  the  information 
from  one  tactile  sensor  can  not  completely  determine  the  motion  of  the  moving 
body.  In  this  section  we  shall  show  that  with  two  points  of  contact,  each  with  a 
tactile  sensor,  we  can  in  general  (except  for  some  special  geometries)  completely 
determine  the  angular  velocity  and  sliding  velocity,  and  their  derivatives. 


We  now  assume  that  the  moving  body  is  composed  of  two  or  more  rigidly  con¬ 
nected  surfaces,  each  of  which  continuous  and  differentiable  in  the  neighborhood 
of  the  point  of  contact  (Fig.  3.8). 


v/j 

a/i 


Figure  3.9  Motion  variables  for  multiple  contacts 


We  replace  the  fixed  surfaces  by  two  fingers  of  a  robot  hand,  each  one  in  motion. 
We  label  the  two  contacts  as  point  1  and  point  2.  Associated  with  them ,  V'nj, 
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fimj,  atnj  and  are  respectively  the  velocity  of  the  jth  moving  point,  the 
angular  velocity  of  the  moving  body  relative  to  ground  (expressed  in  the  jth 
reference  frame),  and  their  rates  of  change  (Fig.  3.9(a));  Vf},  afj  and  £l} 
are  the  same  variables  for  the  motion  of  the  point  of  contact  on  the  surface  of 
the  jth  finger  and  the  motion  of  the  jth  finger  (Fig.  3.9(a));  V,,  ClJt  a}  and 
£j  characterize  the  relative  motion  for  the  moving  point  and  the  moving  body 
relative  to  the  jth  finger  (Fig.  3.9(b));  xf] ,  y}] ,  x/}  and  yh  are  the  tangential 
contact  velocity  and  acceleration  at  the  jth  point  of  contact.  For  a  geometric 
variable,  we  add  the  subscript  j  to  indicate  that  it  is  associated  with  the  jth 
point  of  contact. 

Calculating  the  angular  velocity  from  two  contacts 

For  two  points  in  the  moving  rigid  body  we  have 

Kn2  =  ft[Knl  +fim|  X  C j ,  (6.1) 

or 

Kn2  =  RVm\  +  (G .  2 ) 

Here,  r  is  a  position  vector  to  the  second  point  of  contact  measured  in  the  first 
reference  frame,  R  is  a  rotation  matrix  which  transforms  the  coordinates  in  the 
first  reference  frame  to  those  in  the  second  reference  frame,  and 


In  order  to  solve  for  the  angular  velocity,  we  need  to  know  l  m2,  l  ml  ■  From  (2.3), 
(2.4),  Appendix  E  (El)  and  (E3)  we  have, 

Kjxt,  =^’j(wm;,i  -u>/jf,)  + A'jiy(u;mj.2 -w/ji2) +  (umjil  -t>/jt,) 

X  (Ajyfc,  nj,i  ~~  CjQmj)  4  l 'j  }  ,2  )  (  A  j  yQmj  f'jl‘m,,j)i 

^  f  ,  ^  1  —  ^  f  i  •  I  )  Cj(l~‘  ,„j  2  ~~  W  ^  _2)  4"  (  Vmj  i  Vj  f  |  ) 

x  —  (tjk  ra,  ,)  +  (t'mj.s  ,  ,2 )( A  j  z  y 


(6.3) 

(6.4) 


a 


t 
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Solving  these  equations  for  vmjii  and  vmj2,  and  obtaining  vmy,s  from  (E3),  we 
have  the  matrix  expression 

Vm}  =  A(j)Q  +  B(j),  (6.5) 

l  /-5m,  -kmj,  „  0\ 


■A(J)  —  r-  I  kmjtX  gmj  6  1  , 

n  \  0  0  0  / 

/  "h  |k-mJ  ~  Gjgmj)i f}  +  [G}kmj  y  —  K  }<yg  mj)ij  f  t 

B{j)  =  I  V//(2  +  —  Gj  9m])yrj  ~~  _  Gjkmj  ,x)ifl 

V  V/,.* 

/  1  +  \ 

•"  I  ~9n\j{j}  ]y,1  —  I  ) 

where  A'mj  is  the  Gaussian  curvature  of  the  moving  surface  at  contact 
Substituting  (5)  (with  t  =  1,2)  into  (2), 

,4(2)flm2  +  5(2)  =  R[A(l)Qml  +  5(1)]  +  RLiiml, 

and  from  flm2  =  5E!ml  we  have 


Qml  =  [,4(2)5  -  5,4(1)  -  Rl\-'[RB{  1)  -  5(2)].  (6.8) 

Equation  (8)  can  be  used  to  calculate  the  angular  velocity  of  the  moving  body 
from  the  readings  of  two  contact  sensors. 

Calculating  the  angular  acceleration  from  two  contacts 
For  the  two  contact  points  in  the  same  rigid  moving  body  we  have 

am3  =  5[aml  +  £xr  +  Qx{Qx  r)],  (c.9) 


a  m3  —  5(ami  +  L(ml  +  C), 


(6.10) 


Si 
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where 

(u>,(u>2r2  +  v3r3)  -  r,(u^  4-  u>|)  \ 
w2(w3r3  +w,r,)  -  r2(w3  4-u;?)  1 
w3(w,r,  +w2r2)  -  rs(u;f  +  u\) ) 

In  order  to  solve  for  the  angular  acceleration,  we  need  to  know  am2  and  am) . 
Similar  to  the  previous  case  solving  for  amj ,  and  amj  2  from  (2.9),  (2.10),  (E2) 
and  (E4),  and  obtaining  amj3  from  (E4),  we  have 

a  mj  =  A(j)S  +  D(j),  (6.11) 


i  ( [(Ky,**»y,»  —  G}gmj )xfi  4-  ( Gjkmjit  —  Kjitgmj) ytj  4-  gmjTj2  ~  ^«y,»2y i]  \ 

0(i)  =  v; -  (  [(^O'.Ji^my,*  ~  Gj3mj)i/t,  —  —  Gj9mj)zti  +5m>7yi  -  kmj  xT)2]  I  + 

Amy  y  Q  J 

<*/,.«  -  2Vj,2w/j,3  +  jm/Wy.S  +  ffj^-lSm>(eM,l  +  ^ti,2Q).3  ~  “  fj, 3*1,2)  +  fc»>,f(«M,2  +  W/>.3<V>.1  -  W^.lWy.j)] 

a/,,2  +  2Vj,lV„,3  ~  *mj*j,3  ~  «(«„•,!  +  “ti,2*j.3  ~  * ti,3*},2)  +  9mj{t ,,  ,2  +  “„,3*j,l  ~  “,,,1  ^>j.3 )J 

a/i.3  +  -  Cy,I w,>.2 

(6.12) 

where 

Tji  =U)j'XU)jt3  4"  2u ! j  3(gmJX mj  +  kmj.yi/m})  ^  4"  2 &»y,xy*il/i  +  k,j  yxy rt ) 

9 mj^j, 3i 


Tj2  Wjjijj'i  2u/jt3(kmj'XXmj  4"  gmj'yrnj)  ^  ^(^'O.Jy^'i  4”  2&iyiyIZ,y,  4~  ^ij.yyDi  ) 

i 

3  rnj^j  ,3t/mj  4"  ^  rnj,y%  mj^j  ,3  • 

Here  the  summation  is  over  m  and  /. 


Substituting  (11)  (with  j  =  1,2)  into  (10),  we  have 


v4(2)£m2  4-  Z?(2)  =  tf[/l(l)£ml  4-  Z?(l)j  4-  +  *C. 


From  <fm2  =  R<fml ,  we  have 


fml  =  [4(2)tf-iM(l) -/?£]-' (fl£>(l)  4- flC-.D(2)].  (6.13) 

Equation  (13)  can  be  used  to  calculate  the  angular  acceleration  of  the  moving 
body  from  the  contact  accelerations  at  the  two  point  contacts. 
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Moving  body  is  two  or  three  spheres 

When  the  moving  surface  is  a  sphere,  A(j)  is  an  anti-symmetric  matrix.  In  the 
general  formulas  (8)  and  (13),  we  can  rewrite  the  matrix  as 

[A(2)R  -  0/1(1)  -  RL]  =  R{R~'A(2)R  -  A(l)  -  L\. 

Since  L  is  also  an  anti-symmetric  matrix,  [0-1  A(2)R—A(\)  —  L]  is  anti-symmetric, 
hence  a  singular  matrix.  The  general  formulas  (8)  and  (13)  can  not  be  applied. 

In  order  to  determine  the  moving  body’s  angular  velocity  from  tictile  sensor 
readings  it  becomes  necessary  to  add  a  third  finger.  If  the  finger  s  such  that 
the  third  surface  is  also  a  sphere,  applying  (2)  and  (5)  for  the  secor  i  and  third 
contacts,  and  adding  the  resulting  equations,  we  have 
a 

nml  =  £>0)^  -  -  0„A(i))]- [(/?i 2  +  r13)b( i)  -  0(2)  -  0(3)]. 

j-i 

(6.14) 

Similarly  applying  (10)  and  (11)  repeatedly  for  the  second  and  third  contacts, 
and  adding  the  resulting  equations  ,  we  have 

3  3 

£m.  =EM(»*u  -  Rx,Lm  -  *.>4(1))]-  X>.,£(1)  +  R„CU  -  D(])}. 

;=2  J=2 

(6.15) 

A  point  and  a  plane  are  two  extreme  cases  of  a  sphere.  When  the  moving  body’s 
contact  surfaces  reduce  to  two  planes,  or  two  points,  or  one  plane  and  one  point, 
we  need  three  contacts  to  determine  the  motion. 

However,  when  the  moving  body’s  contact  surface  reduces  to  one  sphere,  there 
may  be  an  unobservable  slipping  mode.  This  is  because  the  sphere  can  always 
rotate  about  its  center  without  being  affected  by  its  supports.  As  an  extreme 
case,  when  the  moving  body  reduces  to  one  plane  the  same  observation  pertains. 

Approximate  integration  for  position 

If  we  can  assume  that  in  a  small  time  interval,  the  geometry  is  invariant,  we  can 
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approximate  the  position  by  the  differential  form  of  (8) 

$  =  [A(2)R  -  JM(1)  -  RL]-'[RB'{  1)  -  Bm( 2)].  (6.16) 

where  $  is  a  vector  whose  components  are  the  three  infinitesimal  incremen¬ 
tal  angles  the  moving  body  has  successively  rotated  about  the  x,  y  and  2  axes, 
<I>  =  (50,,  60 2,  60s).  From  these  angles  one  can  make  a  rotation  matrix 

R(69t ,  602,  60s).  The  B’(j),  j=  1,  2,  are  similar  to  B  in  (7),  except  the  velocity 
terms  are  replaced  by  the  infinitesimal  rotation  angles. 

This  completes  our  discussion  of  point  contact  between  surfaces.  In  the  next 
chapter  we  study  surfaces  moving  under  line  contact. 


Chapter  4 


SPATIAL  MOTION  WITH 

LINE  CONTACT 


It  is  a  classical  result  that  any  instantaneous  spatial  motion  of  a  rigid  body  can 
be  represented  as  a  moving  axode  in  line  contact  with  a  fixed  axode  along  the 
instantaneous  screw  axis  of  the  motion  [Bottema  and  Roth,  ’79].  However,  for 
rigid  body  motions  with  line  contact  between  two  ruled  surfaces,  the  surfaces  are 
not  necessarily  the  axodes,  and  the  contact  line  is  not  necessarily  the  screw  axis. 
A  simple  example  is  the  line  contact  between  a  finger  of  a  robot  hand,  with  a 
(circular)  cylindrical  shape,  and  a  (circular)  cone  while  the  two  are  in  relative 
motion. 

Here,  we  derive  the  equations  which  govern  the  kinematics  of  the  contact  be¬ 
tween  ruled  surfaces.  We  are  interested  in  knowing  the  velocity,  acceleration  and 
jerk  of  a  reference  point  on  the  moving  body,  the  angular  velocity  and  angu¬ 
lar  acceleration  components,  which  are  perpendicular  to  the  contact  line  of  the 
moving  body,  and  the  contact  speeds  and  their  rates  of  change  on  the  reference 
curves  for  maintaining  line  contact.  In  particular,  we  are  interested  in  obtaining 
the  relationships  between  these  quantities  and  the  parameters  which  define  the 
moving  body’s  motion  at  the  contact  line. 

Following  a  similar  route  to  the  one  taken  for  point  contact,  in  this  chapter  we 
first  analyze  the  basic  constraints  associated  with  line  contact,  then  obtain  the 
motion  properties  and  their  variations  under  special  geometries.  These  properties 
are  further  extended  for  two-line  contact. 
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Besides  the  general  line  contact  motions,  which  are  called  roll-slide  motions,  we 
discuss  three  types  of  special  motions:  1)  there  is  no  rotation  about  the  line  of 
contact;  2)  there  is  no  sliding  perpendicular  to  the  line  of  contact  at  one  point, 
which  can  be  assumed  to  be  the  reference  point;  3)  there  is  no  sliding  along  the 
contact  line.  If  both  ruled  surfaces  in  contact  are  cylindrical  surfaces  and  the 
last  condition  is  satisfied,  the  first  two  special  motions  become,  respectively,  1) 
pure  translation  and  2)  pure  rotation  about  the  instantaneous  line  of  contact. 

4.1  Constraints  on  line  contact 


Figure  4.1  Arbitrary  position  of  a  moving  surface  in  line  contact 


In  this  section,  we  specify  a  contact  model,  then  consider  the  basic  constraints  on 
the  contact  normal,  contact  line,  contact  trajectories,  moving  point,  and  special 
motions. 

The  contact  model  is  illustrated  in  Fig.  4.1.  To  be  practical  and  for  simplicity,  we 
exclude  skew  ruled  surfaces,  and  consider  only  developable  ruled  surfaces,  i.e., 
ruled  surfaces  whose  consecutive  generators  intersect  each  other.  The  moving 
ruled  surface  is  labeled  as  m,  and  the  fixed  ruled  surface  as  /.  The  contact  is 
between  a  fixed  line  and  a  moving  line.  A  point  Pm  on  the  initial  moving  line  is 
designated  as  the  moving  point,  and  its  trajectory  the  moving  point  trajectory. 
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Symmetrically,  a  fixed  point  Pf,  which  is  coincident  with  Pm  in  the  initial  instant, 
is  designated  as  the  fixed  point  and  used  for  reference  purposes. 

We  imagine  a  pair  of  unit  vectors  Lm  and  Lj,  with  their  tails  at  a  fixed  origin, 
which  do  not  belong  to  either  body  and  are  always  parallel  to  the  current  po¬ 
sition  of  the  instantaneous  contact  line  of  the  moving  and  fixed  ruled  surfaces, 
respectively.  As  the  contact  changes,  the  vectors  Lm  and  Lj  trace  cones  of  unit 
length.  Associated  with  each  contact  line,  we  specify  a  pair  of  points,  Qm  and 
Q f,  which  as  we  move  from  contact  line  to  contact  line  trace  spatial  curves  on  the 
ruled  surfaces.  The  points  are  coincident  with  Pm  in  the  initial  position.  When 
viewed  from  the  moving  and  fixed  surface,  the  trajectories  of  Qm  and  Qf  (the 
curves)  and  those  of  Lm  and  Lj  (unit  length  cones)  characterize  the  contacting 
ruled  surfaces  (Fig.  4.1). 

We  define  the  moving  frame  and  the  fixed  frame  so  that  they  are  coincident  with 
each  other  in  the  initial  instant:  the  points  Ptn  and  Pf  are  used  as  the  frame 
origins;  the  z  axes  (zm  and  zf )  are  along  the  coinciding  lines  of  contact;  the  y 
axes  (ym  and  yf)  are  along  the  common  surface  normal  (directed  in  toward  the 
moving  surface);  and  the  x  axes  (xm  and  xf)  are  in  the  common  tangential  plane 
and  perpendicular  to  the  line  of  contact.  Below,  when  we  specify  the  motion 
components  with  respect  to  these  axes  we  use  the  subscripts  L,  A ,  T,  which 
represent  the  direction  of  the  line  of  contact,  surface  normal  and  orthogonal 
tangent,  respectively. 

We  denote  the  trajectories  of  Qm  and  Q j  by  the  variables  rm  and  rf  (the  position 
vectors),  respectively.  A  moving  ruled  surface  can  be  represented  by 

Rm  m  4“  dmLm,  (1.1) 

and  a  fixed  ruled  surface  can  be  represented  bv 

Rf  =  rf  +  dfLf.  (1.2) 

Rm  and  Rf  are  the  position  vectors  for  generic  points  on  the  ruled  surfaces, 
and  dm  and  dj  are  the  distances  measured  from  rm  and  rf  to  the  specified 
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points  along  the  corresponding  rulings.  To  simplify  our  derivation,  we  assume 
the  tangents  to  the  curves,  denoted  by  all  values  of  rm  and  ry,  are  perpendicular 
to  the  corresponding  rulings  at  each  instant.  (In  Appendix  D  we  show  that  such 
curves  and  their  corresponding  rm  and  rf ,  are  easily  obtainable  from  an  arbitrary 
representation  of  a  ruled  surface). 

We  will  use  the  subscript  i  whenever  either  m  or  f  can  be  used.  This  convention 
implies  that  the  same  quantity  must  be  used  throughout  the  entire  equation. 


Constraints  on  contact  normal 


A  unit  vector,  which  is  parallel  to  the  inwardly  directed  normal  of  the  moving 
surface  or  the  outwardly  directed  normal  of  the  fixed  surface,  can  be  expressed 

as: 


fin  no 

N'  =  jj-*^r  =  L'x  to' + <w;)/i^  *  to' + <wai- 


The  unit  surface  normals  along  the  same  generator  of  a  developable  ruled  surface 
are  all  parallel,  i.e.,  they  are  independent  of  dx.  Hence,  L\  must  be  a  linear 
combination  of  L,  and  r',  and  the  expression  for  N,  can  be  simplified  to 


Nm  =  Lm  x  r'/| Lm  x  r'|, 

(1.3) 

Nf  =  Lf  x  r'/|Z,y  x  r'|. 

(1.4) 

In  order  to  maintain  line  contact,  the  inwardly  directed  surface  normal  associated 
with  Lm  and  the  outwardly  directed  surface  normal  associated  with  Lj  must  be 
coincident.  Thus  we  require  that 

N}  =  RNm,  (1.5) 

where  R(t)  is  a  3  x  3  rotation  matrix  which  transforms  the  coordinates  of  the 
moving  system  to  their  values  in  the  fixed  system;  the  derivatives  of  R(t)  have 
been  analyzed  in  (Bottema  and  Roth,  ’79]  (on  p.  22). 


On  the  other  hand,  from  differential  geometry,  the  derivatives  of  a  spatial  curve 
with  respect  to  its  arc  length  satisfy  the  relationships: 
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where  k  is  the  curvature  and  r  the  torsion  of  the  curve,  and  t,n,b  are  the  unit 
vectors  along  the  tangent,  normal  and  bi-normal  directions,  respectively.  For 
simplicity,  we  define  n,N  =  n,  ■  /V  ,  n,L  =  n,  •  L,  biN  =  b,  •  N,  b,L  =  b,  the 
angular  velocity  of  the  moving  body  0  =  [u;r  wL]T  y  and  the  body’s  angular 
acceleration  vector  6  =  [€r  <z.]T- 

Now  we  can  obtain  the  first  order  and  the  second  order  constraints  on  the  contact 
normals.  Substituting  (3)  and  (4)  into  (5),  and  using  the  above  curve  kinematics, 
the  first  order  constraints  on  the  contact  normal  are: 

UJj1  0,  iO  l  K  jTl  j  ^  8  j  K.  m  U  m  ^  8  m ,  (l.fi) 

where  sm,  s f  are  the  contact  speeds  along  rm  and  r^,  respectively.  Similarly,  the 

second  order  constraints  on  the  contact  normal  are: 

^  N  '  N  $  m  d~  ^  fT^  j  h  $  f  t  N  ^  h  7ym^, 

(1-7) 

(  L  ~  ~KmnmNsm  ~~  [KmTm^mN  d"  K  m11 N  )*r n  d"  K  /  n  j  s  8  /  +  (KfTI^lN  d-  K  fn  ,  N  Is  j  ■ 

(1.8) 

The  dots  denote  the  time  derivatives,  and  we  have  used  the  conventions  that 
L,t  =  Li  T,  LiT  —  L,  T,  L,n  =  L,  N  and  L,l  =  L ,  •  L.  The  normal  component 
of  the  derivative  equation  from  (5)  does  not  provide  new  information,  since  we 
have  the  constraints  NJ N,  =  1. 

Constraints  on  contact  line 

To  maintain  line  contact,  the  unit  vectors  parallel  to  the  contacting  moving 
ruling  and  contacting  fixed  ruling  at  each  instant  must  be  parallel  to  each  other, 
therefore 

L,  =  R{t)Lm.  (1.9) 

Taking  the  first  two  derivatives,  we  obtain  the  conditions  for  the  normal  angular 
velocity  and  angular  acceleration  to  maintain  line  contact. 


^  f  T  , 


(1.10) 


g 
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cN=Lfr-LmT.  (1.11) 

The  rest  of  the  components  of  the  constraint  equations  from  the  derivatives  of 
(9)  are  consistent  with  those  contact  normal  constraints. 

From  spherical  differential  geometry,  it  is  known  that  the  derivatives  of  L,  with 
respect  to  the  arc  length  of  the  spherical  curve,  are  related  to  the  geodesic  cur¬ 
vature,  7,,  of  the  spherical  curve: 

V  =  f,  V  =  y,G  -L,  G'  =  -7,T,  (1.12) 

where  L,T  and  G  are  three  perpendicular  unit  vectors.  From  our  previous  anal¬ 
ysis,  we  know  that  dLJds,  is  a  linear  combination  of  L,  and  r'  (or  T),  and  from 
the  relation  LT  L  =  1,  we  conclude  that  L  is  parallel  to  T.  Hence,  in  (12)  T  is 
parallel  to  T,  and  G  is  parallel  to  the  surface  normal  N.  Thus, 

L'  =  T,  L"  =  7,/V  -  L. 

For  the  time-based  derivatives,  there  exists  the  relation  dl^/dt  =  (dL/da,)  (da,/ 
dl),  or 

L  =  I/a„  L  -  L"d]  +  L'at,  (1.13) 

where  designates  the  spherical  arc  length. 


Figure  4.2  Contact  trajectories  on  ruled  surfaces 
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Constraints  on  contact  trajectories 

The  need  for  contact  constrains  the  points  on  the  contact  trajectories;  this  pro¬ 
vides  the  relationship  between  Rm  in  (1)  and  Rj  in  (2),  and  the  relationship 
leads  to  the  introduction  of  a  quantity  we  call  the  sliding  velocity. 

We  let  Rm  in  (1)  represent  the  trajectory  of  Qm  by  taking  dm  =  0,  and  let  Rj  in 
(2)  traces  the  locus  of  Qm  in  the  fixed  space,  then  from  Fig.  4.2: 

Rf  =  Pjm  +  R(l)  Rm,  (114) 

where  P/m  is  the  position  vector  for  the  moving  point  Pm.  The  first  order  time 
derivative  of  (14)  is 


Rf  =  [Pfm  +  R(t)Rrn)  +  R(t)Rm.  (1.15) 


As  in  the  previous  two  chapters,  the  content  of  the  first  square  bracl  et  is  a  general 
expression  for  the  sliding  velocity  at  Qm,  and  the  introduction  of  sliding  velocity 
is  meaningful  to  the  application.  By  Taylor  series  expansion,  the  sliding  velocity 
can  be  expressed  as 

V(t)  =  V  (0)  +  U(0)t  +  ••  • 

Using  this  notation,  we  can  write  the  nth  order  time  derivative  of  (15)  as 


R(; 0  =  V<">  +  [/?(0Pm]". 


Taking  n  —  0  in  equation  (16),  we  have 


vT  =  sf  -  sm,  vL  =  df,  =  0. 


When  n  =  1  we  have 


vT  =  s}  -  sm  +  2 dfLf, 

VL  =  K,nU»)  ~  Krr,nm,  Prn  +  (if  +  wlvara, 


=  K,n,NS)  “ 


(1.16) 


(1.17) 


(118) 

(1.19) 


(1  20) 
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For  the  nth  order  moving  point’s  kinematics,  we  have  from  (15), 


p(  n+* )  _ 


V'(">  -  [R(t)Rm}(n\ 


(1.21) 


Constraints  on  special  motions 

We  now  look  at  the  special  motions  up  to  second  order. 
When  there  is  no  rotation  about  the  line  of  contact,  we  have 


0  L  =  0  (122) 

Taking  the  first  two  derivatives,  and  solving  for  the  angular  velocity  and  angular 
acceleration  about  the  line  of  contact,  we  have 

u jl=0,cl=0.  (1.23) 

When  there  is  no  sliding  velocity  perpendicular  to  the  line  of  contact  at  the 
reference  point,  we  have 

V  -  (V  ■  L)L  =  0.  (1.24) 

Taking  the  first  two  derivatives  and  solving  for  the  sliding  velocity  and  accelera¬ 
tion  which  is  along  T,  we  have 

vT  =  °,  vT  =  vt  LT  (125) 

When  there  is  no  sliding  along  the  line  of  contact,  we  have 

v  •  L  —  0 .  (1.26) 


This  and  its  derivative  yield 
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Figure  4.3  Projectional  curves 
4.2  Motion  properties  for  line  contact 

From  the  constraint  relationships,  in  this  section  we  derive  the  first,  and  second 
order  contact  speeds  along  the  reference  curves,  and  the  first,  second  and  third 
order  motion  derivatives  of  the  moving  reference  point;  these  results  are  expressed 
as  functions  of  sliding  at  the  reference  point  and  the  rotation  about  the  line  of 
contact.  We  also  illustrate  how  to  plan  for  line  contact  motions  which  maintain 
a  desired  contact  trajectory. 

We  define 

K  =  KmnmN  -  KfvfN. 

and  —KfnfN  are  the  curvatures  of  the  curves  obtained  when  rm  and  r; 
are  projected  onto  a  plane  perpendicular  to  the  line  of  contact  (Fig.  4.3).  Up 
to  second  order,  rm  and  Tj  can  be  replaced  by  circles  with  curvature  Km  and 
Kf,  and  principal  normals  nm  and  n/,  respectively.  The  projection  of  these  two 
circles  onto  a  plane  which  is  perpendicular  to  the  line  of  contact,  is  two  ellipses  in 
contact,  and  their  curvatures  at  contact  are  KmnmN  and  — /c/n/;v,  respectively. 
When  two  convex  projected  curves  (curves  bent  in  opposite  directions)  are  in 
contact,  K  is  always  positive  since  by  our  coordinate  convention  only  n/N  is 
negative. 

The  speeds  of  Qm  and  Qj,  sm  and  sf,  are  obtainable  from  (1.6)  and  (1.10): 


>  .S  ,\  / 


86  Chapter  4:  Spatial  Motion  with  Line  Contact 


«/ =  "  *mnm„ t/T].  (2.2) 

Independent  of  vL,  sm  and  sj  are  proportional  to  the  angular  velocity  about 
the  contact  line  and  the  sliding  velocity  perpendicular  to  the  contact  line  at  the 
reference  point.  This  result  is  exactly  the  same  as  if  the  motion  were  constrained 
by  point  contact  of  the  two  projected  curves.  These  relations  are  useful  for  path 
planning  and  sensing  purposes. 

When  there  is  no  sliding  perpendicular  to  the  contact  line  at  the  moving  point, 

Sm  =  s/  =  (2-3) 

In  words,  sm  and  sj  are  equal  to  the  negative  of  the  ratio  of  ur  and  the  sum 
of  the  curvatures  of  the  projected  curves.  If  we  can  calculate  sm  or  sf  from  a 
tactile  sensor  reading,  we  can  determine  ioL  from  (3),  assuming  we  know  the 
surface  geometry  and  position  of  contact. 

When  there  is  no  rotation  about  the  contact  line, 

1.1 

5m  K  fn  f  NVT  >  Sf  ^m^mfsr^T  *  '  V 

When  the  ratio  of  the  curvature  of  the  projected  moving  curve  to  that  of  the 
projected  fixed  curve  is  very  small,  sm  is  approximately  equal  to  vT,  Sf  is  ap¬ 
proximately  proportional  to  this  ratio,  and  vice  versa. 

The  moving  point’s  velocity  is  equal  to  the  sliding  velocity  if  we  take  n  =  0  in 

(1.21): 

PT  -  VT  ,  Pi.  =  VL’  K  =  0-  (2-5) 

No  matter  whether  vT  vanishes  or  not,  there  is  usually  sliding  perpendicular  to 
the  line  of  contact  for  a  generic  point  on  the  line  of  contact,  and  the  sliding 
velocity  has  a  linear  distribution  along  the  line.  When  both  spherical  image 
curves  (see  foot  note  on  p.  6),  of  Lm  and  Lf ,  advance  at  the  same  speed,  from 
(1.12)  and  (1.13)  the  normal  angular  velocity  vanishes,  and  the  sliding  velocity 
is  the  same  (it  can  be  zero)  for  every  point  on  the  contact  line.  On  the  other 
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hand,  the  normal  velocity  vN  vanishes  at  every  point  on  the  contact  line  since 
ujt  =  0.  This  property  can  be  useful  in  searching  for  the  contact  line  (provided 
the  geometry  and  motion  of  the  moving  rigid  body  are  given).  The  velocity 
component  along  the  contact  line  vL  is  the  same  for  every  point  on  the  line.  If 
a  point  of  the  contact  line  is  in  the  sensing  range  of  a  tactile  sensor,  we  can 
determine  vL . 

The  rates  of  change  of  the  contact  speeds  on  the  curves  rm  and  rf  are  obtainable 
from  (1.8)  and  (1.19): 

~  Ip  ~  K )  n/N  *T  ~b  n  J  N  ^  It  VL  "b  (KmTmbmN  T 

A  (2.6) 

-  ( K,T,b,N  +K'lnfN)S)l 

sf  ~~K^L  ~  KmTlTnN^T  "b  2 KmnmN  LjTvL  +  (/cmTm6mN  +  KmnmN)sm  ^  ^ 
-(K,T,b,s 

When  the  first  order  motion  properties  are  determined,  equations  (6)  and  (7) 
give  the  relationships  between  the  rates  of  change  of  contact  speeds  on  curves  rm 
and  Tf,  the  sliding  acceleration  component  which  is  perpendicular  to  both  the 
contact  line  and  contact  normal,  and  the  angular  acceleration  about  the  line  of 
contact. 

When  there  is  no  sliding  perpendicular  to  the  contact  line  at  the  reference  point, 
substituting  (1.25)  into  (6)  and  (7)  yields 
..1  w2 

Sm  L  ~b  [(^m'r,n^inN  T  K  Um;v)  ~b 

(2.8) 

..1  ■  ui2 

3/  ~  [f /.  “b  2«mnmN  L  fT  VL]  +  — ~  [(«:,„  +  KmnmN)  ~  (k  J  TfbfN  "b  K  f  n  I  N  )]• 

(2.9) 

The  accelerations  sm  and  st  are  linearly  related  to  eL.  When  vL  =  0,  sm  =  sf. 

When  ther».  is  no  rotation  about  the  contact  line,  substituting  (1.25)  into  (6)  and 
(7)  yields 


K  i  n/Nbr  "b  2k;  Ljt  vl]  +  [(^mrm6mfsr  +  KmnTTlN)K^  nfN 

-  (K,T,b,s  +  K',n,N)«N}~^ 


(2.10) 


t 
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&  f  “f"  2  K  m  n  m  L  V I  ]  H-  [  (  ^  m  ^*m  "f"  )^j  ^//V 


-Kr/6^ 


(2.11) 


The  accelerations  sm  anti  Sj  are  linearly  related  to  vT. 

The  second  order  properties  of  the  moving  point  are  obtainable  by  taking  n  =  2 
in  (1.21)  and  substituting  the  results  into  (2.1)  and  (2.2): 


pT=i>T,  (2.12) 

Pl  =  *1.  +  J’Un(ul  ~  K/n/NvT^  (2-13) 

1  o  i  2 

Pn  =  +  -jrK„lKlnmsnINvl  -  —Kfn/Nu>L  vT.  (2.14) 

The  normal  acceleration  is  independent  of  vL,  and  is  determined  from  the  first 
order  relative  motion  of  the  projected  moving  and  fixed  curves. 

When  there  is  no  sliding  perpendicular  to  the  contact  line  at  the  moving  point, 


pT  (215) 

Pl  ={)l  ~  jru>Lu>N,  (2.16) 

Pn  =  ]■<  (2-17) 

When  either  vL  vanishes  or  d,  vanishes  (the  spherical  image  is  stationery),  pT 
vanishes.  The  normal  acceleration  is  proportional  to  the  square  of  the  angular 
velocity  about  the  line  of  contact,  and  inversely  proportional  to  the  sum  of  the 
curvatures  of  the  projected  curves.  This  resembles  planar  pure  rolling  about  the 
point  of  contact. 

When  vL  =  vL  =  0,  then 

llL  = 

Pl 

This  resembles  spatial  pure  rolling  about  the  point  of  contact. 
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Figure  4.4  Two  reference  frames  on  a  fixed  surface 
When  there  is  no  rotation  about  the  line  of  contact, 

pT=vT,  (2.18) 

...  1  , 

Pl  =  VL  +  (2.19) 

P„  =  (2  20) 

The  normal  acceleration  is  proportional  to  the  square  of  the  sliding  velocity 
component  perpendicular  to  the  line  of  contact,  and  is  inversely  proportional  to 
the  sum  of  the  radii  of  curvatures  of  the  projected  curves.  This  formula  resembles 
the  one  for  planar  pure  translation  between  two  curves  with  point  contact. 


For  the  third  order  properties  of  the  moving  point,  we  take  n  =  3  in  (1.21)  and 
obtain 


PT  vt  T  2(w^  +  u> L  )im  +  KrnnmNu>L  sm  KrnnTTlLu>Nsrn,  (2.21) 

vL  +  2eNSm  +  wNsm,  (2.22) 


P  S  Tf  bfN  +  KmTlTnN)s  n  +  fn  f  nS  fS  j 


(2.23) 


3^cm7im^5m5m)  T  3u ^  L j ^  3eL  sm  3 
where  sm  and  sf  are  given  by  (6)  and  (7).  The  expressions  for  special  motions 
are  obtainable  by  substituting  the  corresponding  special  cases  for  i,,  s,. 


The  constraints  on  the  angular  velocity  and  angular  acceleration  for  the  compo¬ 
nents,  other  than  about  the  contact  line,  have  already  been  obtained  in  (1C), 
(1.7),  (1.10)  and  (1.11). 
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The  foregoing  first  and  second  order  motion  properties  arc  useful  for  path  plan¬ 
ning,  even  if  we  originally  have  two  different  representations  for  the  contacting 
surfaces.  Assuming  that  with  respect  to  arbitrary  moving  and  fixed  frames  (we 
call  them  the  original  moving  and  fixed  frames),  both  contacting  developable 
ruled  surfaces  are  represented  by 

R,  =  r,+  d.L,. 

We  can  preplan,  with  respect  to  the  original  frames,  the  trajectories  of  rm,  dj 
and  f/,  then  transform  the  variables  with  respect  to  the  contact  reference  frames. 
For  example,  on  the  fixed  surface  (Fig.  4.4)  we  assume  P0j  is  the  position  vector 
for  the  reference  point  with  respect  to  the  original  frame,  and  T  is  the  rotation 
matrix  transforming  the  coordinates  of  the  contact  reference  frame  to  the  original 
frame,  then  from  the  relation 

Rf  -■  Pof  +  TR},  Rj  =  TRf,  Rj—TRf , 

we  can  determine  the  values  of  sf,  vT  and  those  of  their  derivatives  which  we 
would  need  in  order  to  evaluate  the  motion  expressions  we  have  studied  so  far. 

4.3  Line  contact  between  two  circular  cones 


fiW 
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To  illustrate  the  general  properties,  we  now  apply  them  to  the  case  where  two 
circular  cones  are  in  relative  motion  with  line  contact. 

We  pick  rm  and  r /  as  position  vectors  for  the  points  on  the  two  circles  cut  by 
planes  perpendicular  to  the  cone  axes  and  going  through  the  reference  point  (Fig. 
4.5).  Hence, 

Km  —  >  K,  =  ~~ )  K  ~  K.  —  Tm  —  Tf  ~  0. 

Pm  Pf  ’ 

The  principal  normals  for  the  circles  rm  and  rf  at  the  reference  point  are,  re¬ 
spectively, 


n„  =  I  coso 


n  /  =  I  —  cos  a , 


Here,  the  coordinate  axes  are  as  described  in  Fig.  4.5. 

To  evaluate  Lt,  we  define  a  second  set  of  moving  and  fixed  frames  with  their  z 
axes  parallel  to  the  cone  axes,  and  their  x  axes  parallel  to  those  of  the  original 
reference  frames,  respectively.  We  can  express  in  the  second  moving  frame, 

(sin  am  sin  9m  \ 

—  sin  orm  cos#m  I  . 
cosorm  / 

Taking  the  first  two  derivatives,  and  evaluating  them  at  9m  —  0  yields 


f  m2  I  fi  I  f  m2 

\  0  / 


sin  am  1  0^  +  0  0, 


By  a  simple  coordinate  rotation,  we  obtain  the  desired  derivatives  of  L  with 
respect  to  the  original  moving  frame, 

(10  0  \ 

f  m  f m  f  m2  i  ^"m  I  0  COS  Of m  SinOm  I  . 

\  0  —  sin  arm  cosam/ 

Similarly,  Lf  expressed  with  respect  to  the  second  fixed  frame  is 

/  sin  o;  sin  9 f  \ 

Lj2=  I  sina/Cost?y  I  . 


$ 

!® 
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Taking  the  first  two  derivatives,  and  setting  Q  f  —  0  yields 

(sinctyX  /  0  \  /  sin«y\ 

0  1  #y,  L)2  =  f  — sinor/  I  $y  +  I  0  I 

By  a  simple  coordinate  rotation,  we  obtain  the  desired  derivatives  of  Lj  with 
respect  to  the  original  fixed  frame. 

/f  0  0  \ 

L j  —  Tj  L j2,  Tf  =  0  cos  cij  —  sin  ary  I  . 

\0  sin  ary  cos  Of  f 

The  speeds  of  Qm  and  Qf ,  and  sf,  are  obtained  by  substituting  the  above 
expressions  into  equations  (2.1)  and  (2.2) 

3m  =  ~P\uL  +  —  COSttyU  ],  (3.1) 

Pt 


where 


Sf  =  ~p[uL - -cosarmvT], 

Pm 


PmPf 


Pm  COS  OC y  +  p,  COS  Om 

As  far  as  am  and  s y  are  concerned,  a  line  contact  between  two  developable  ruled 
surface  is  equivalent  to  a  line  contact  between  two  circular  cones. 

For  the  corresponding  special  motions,  when  there  is  no  sliding  velocity  per¬ 
pendicular  to  the  line  of  contact  at  the  moving  point,  im  and  sy  will  be  small 
(the  sensitivity  of  tangential  contact  speed  to  rotational  motion  is  reduced)  when 
either  or  pj  is  small.  When  there  is  no  rotation  about  the  line  of  contact, 

V-  v _  . 

3  m  =  —  T~T  T,  Sf  =  77  r  ■  (3-3) 

1  -I-  COSampy/(cOS«ypm)  1  +  COS  Qypm/(cOS  Otmp,  ) 

If  the  ratio  cosaypm/(cosampy)  decreases,  sm  decreases  while  iy  increases,  and 
vice  versa. 

The  rates  of  change  of  the  contact  speeds,  sm  and  «  ,  are  obtained  by  substituting 
the  above  expressions  inio  (2.G)  and  (2.7): 

3  m  =  -p[tL  +  —  cosafvT - sin(2«y  )u  S  y),  (3.4) 

pf  pf 


(3.4) 
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g 

8 

$ 

I 


s,  —  - p[i , - cosnmvT  H - sin(2a/)u,  .«/]•  (3.5) 

Pm  PmP  j 

When  vL  =  0  ,  one  obtains  similar  relationships  for  sm,  s  j ,  f  L  and  vr  to  those  we 
found  for  and  vT. 


The  moving  point’s  acceleration  are  obtained  from  (2.12)-(2.14): 

Pt  =  "t» 


1 


pL  =VL-  pu}N[uL  +  —  COS CX j Vj. ] , 

Pi 


(3.6) 

(3.7) 


pN  =  pw;  - 


2p 


- cosom  cosar/t;  H - cos«iw,ti7 

PmP/  Pf 


(3.8) 


The  normal  acceleration  is  exactly  the  same  as  when  two  ellipses  with  semi  radii 
p,  and  p,c os  a,  are  in  contact  with  each  other  at  the  symmetric  point  associ¬ 
ated  with  the  normal  radii.  As  far  as  the  normal  acceleration  is  concerned,  any 
line  contact  between  two  developable  ruled  surface  is  equivalent  to  line  contact 
oetween  two  circular  cones. 


The  jerk  components  of  the  moving  point  are  obtained  from  (2.21  )-(2.23): 


..  i  o/  2  i  2  \  •  COSGfm  Sin  Qfm  «2 

Pt  =  vt  +  2(<  +  5^  +  — - u;„s2 


N  m 1 


=  5£,  +2f/V'4rn  +WNSm, 


3  sin  a  ( 


(3.9) 

(3.10) 


,,,  COS  Q!  t  .  ..  COSOtm  .  ..  o  sill  uc  f  .,  . 

p'*'  =  — 3( - —  SfSf  +  - — — -smsm)  -  —  2  -  cosafvLsf  -  3ct*m  -  3 ujls, 

Pf  Pm  Pf 

(3.11) 


It  is  also  easy  to  see  the  orientation  constraints  for  maintaining  line  contact.  The 
angular  velocity  constraints  are  obtained  from  (1.6)  and  (1.10): 

w  =  0,  uN  =  —  sino/iy - —  sinamsm.  (3-12) 

Pf  Pm 

For  two  identical  circular  cones,  when  there  is  no  sliding  perpendicular  to  the  line 
of  contact  at  the  moving  point,  the  normal  component  of  the  angular  velocity 
vanishes.  The  angular  acceleration  constraints  are  obtained  from  (1.7)  and  (1.11): 


2  cos  a  r 


3siii(2a/)  .,  3sin(2am)  .. 


2p} 


-s ,  - 


2p? 


(3.13) 
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moving 
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Figure  4.7  Reference  lines  of  a  moving  body 

Hence,  the  contact  speed  along  Tj  and  its  rate  of  change  are  equal  to  the  compo¬ 
nent  of  sliding  velocity  and  sliding  acceleration  along  the  curve  tangent,  respec¬ 
tively. 

Similarly,  we  have  the  acceleration  and  the  jerk  of  the  moving  point.  The  moving 
point’s  acceleration  is  obtained  by  substituting  (1)  and  (2)  into  (2.12)-(2.14): 

pT  =  v.r ,  p,  =  v,  .  pN  =  Kfn/Nxr.  (4.3). 

And,  the  moving  point’s  jerk  is  obtained  by  substituting  (1)  and  (2)  into  (2.21)- 

(2.23): 

Pr3)  =  5t.  P(LS>  =  l’f. -  P[ "  =  K,T,b,Ns)  +  *K,n,N*fSf  (4-4) 

Substituting  (1)  into  (1.21),  we  see  that  the  acceleration  and  jerk  of  the  moving 
point  are  equal  to  the  slidimr  velocity  and  its  rate  of  change. 

We  can  also  have  the  special  orientation  constraints.  The  angular  velocity  satis¬ 
fies  the  following  conditions  from  (1 .6)  and  (1.10): 

u>T  =  0,  ui v  =  L fr .  (4-5) 

This  means  that  the  normal  angular  velocity  is  equal  to  the  speed  on  the  fixed 
spherical  curve.  The  angular  acceleration  satisfies  the  following  conditions  from 
(I-7Mi.ll): 

fT  —u>NuiL  ~h  2u>L(u>L  —  K^n^NvT)  —  L  j  N  2  K  j  n ,  ^  L  jT  s  j ,  <N  7/^T.  ('10) 
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The  case  where  a  moving  surface  reduces  to  a  line  is  useful  for  path  planning  with 
regard  to  orientation.  A  robot’s  orientation  “path”  can  be  partially  represented 
by  a  cone,  with  each  ruling  parallel  to  a  different  position  of  the  same  reference 
line  of  the  moving  body  (the  axis  of  a  circular  peg  is  an  example  of  a  useful 
reference  line).  The  orientation  of  the  moving  body,  relative  to  the  cone,  can 
be  represented  by  an  angle  <f>  between  the  surface  normal  N  of  the  cone  and 
a  second  line  //,  which  is  fixed  in  the  moving  body  and  perpendicular  to  the 
original  reference  line  L  (Fig.  4.7).  The  motion  of  L  is  equivalent  to  that  of  a 
line  moving  on  a  cone  with  line  contact.  Since  L  does  not  slide  along  itself,  r f  is 
a  spherical  curve.  Rotation  about  the  line  of  contact  gives  the  relative  angular 
velocity  and  the  angular  acceleration  (from  (G)). 

Fixed  surface  is  a  line 

This  occurs  when  the  fixed  surface  becomes  an  edge.  Symmetric  to  the  previous 
case,  the  speeds  of  Qm,  Q  and  their  rates  of  change  are: 

«m  =  ~VT,  Sm  =  ~VT,  (4.7) 

Sf  =  Sj  =  0.  (4.8) 

The  components  of  the  moving  point’s  acceleration  are  obtained  from  (2.12)- 
(2.14): 

Pt=vt<  (4.9) 

PL=i,L-“NVT<  (4.10) 

PN  = -K,nnmsi  v7t+2ulvt.  (4.11) 

The  moving  point’s  jerk  is  obtained  by  substituting  (7)  and  (8)  into  (2.21  )-(2.23): 

PT  Vf  ~b2(u>L  Tww)sm4-/cmnmvwtsm  s m ,  (4.12), 

P(l]  =  vL  +  2«n  +  wNi'm, 


(4.13) 

(4.14) 
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The  sliding  terms,  in  the  direction  perpendicular  to  the  line  of  contact,  are  dom¬ 
inant  for  the  normal  acceleration  and  jerk. 


The  angular  velocity  satisfies  the  following  conditions  from  (1.6)  and  (1.10), 


^7.  —  ^  n  i'mf! 


(4.15) 


and  the  angular  acceleration  satisfies  the  following  conditions  from  (1.7)-(1.1 1 ), 
€7.  — -  2KrnnrnN uj N s m  4-  L m ^  2/cmnmjvsmLm/v,  L Tn^ .  (4.16) 

The  above  constraints  are  useful  in  path  planning  for  assembly,  if  we  are  required 
to  rotate  a  part  (with  a  developable  ruled  surface)  about  a  sharp  edge  on  another 


Moving  surface  is  a  plane 

To  find  the  speeds  of  Qm,  Q  and  their  rates  of  change,  we  first  take  the  limit  as 
rm  — ►  00  in  (2.1)  and  (2.6), 


K,n,N 


K  -  Kfn/NvT], 


(4.17) 


Ktnt» 


k  -  K,n,si,r  +  2K,n,NVLLfL  -  ( K,T,bts  +  *;»/*)*/!•  (418) 


Then,  we  take  the  limit  as  rm  -*  00  in  (2.2)  and  (2.7): 


K,ntN 


'1  =  k  ~  (K,TtbfN  +  k"/*)*'2/)- 


(4.19) 


(4.20) 


As  long  as  the  fixed  surface  is  not  planar,  the  instantaneous  rotation  about  the 
contact  line,  u>L  and  eL,  can  be  determined  from  sf  and  sj. 

We  have  the  moving  point’s  acceleration  by  substituting  (17)  and  (18)  into  (2.12)- 
(2.14), 

pT  =  vT,  (4.21) 


.v. vvv •vy,->r.  v  « * 


I 


S 


.^1,' 
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Pl  ='}l  +  K  ~ 

Kl  "fN 

..  1  r  *»  «  1 


PN  = 


K,n,s 


/  N  VT  )  * 

(4.22) 

(4.23) 

We  also  have  the  moving  point’s  jerk  by  substituting  (17)  and  (18)  into  (2.21)- 
(2.23), 

p(T3)  =  vT+  2(u£  4-a (4.24) 


^  4-  2eNsm  4-  ujNsm, 


(4.25) 


P(N=(KiT/b/N  +  'c',n/Ji/  +  3AC/n/Ni/S/  +3v/.1/^  -3smef.  -3w,sm.  (4.26) 
The  dominant  term  in  the  normal  acceleration  and  jerk  of  the  moving  point  is 


The  tangential  angular  velocity  and  angular  acceleration  perpendicular  to  the 
line  of  contact  are  from  (1.6)  and  (1.7): 


uT  =  0,  cT  =  -uNuL  -  Lts  4-  2k,  n/NLjs} 


(4.27) 


When  the  moving  surface  reduces  to  a  plane,  any  line  in  the  plane  can  be  a 
ruling;  the  contact  line  constraint  (1.9)  is  not  valid.  Hence,  u>N  and  cN.  become 
free  variables. 

Fixed  surface  is  a  plane 

Symmetric  to  the  previous  cases,  the  speed  of  and  its  rate  of  change  are, 
respectively, 

= - (4.28) 


And,  for  Q 


L  (  ^  m  h  Trips  4"  ml ' 


"[WL 
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&}  L  ^  m  ^"m  ^  rn  ;j  H'  (4 .31) 

m  ^  mv 

As  long  as  the  moving  surface  is  not  planar,  we  can  calculate  u>L  from  .sm,  and 
eL  from  sf. 


We  have  the  moving  point’s  acceleration  by  substituting  (21)  and  (29)  into  (2.12)- 
(2.14): 


Pl  =  v< 


(4.32) 

(4.33) 


P 


N 


(4.34) 


The  moving  point’s  jerk  is  obtained  by  substituting  (21)  and  (29)  into  (2.21)- 
(2.23): 


p(Ts)  =  i)T  +  2 (ur  +  w2  )sm  +  Km7im/vwLs2m  -  KmnmLuJNslt,  (4.35) 

P(l3)  =  *>L  +  2  cN  +  wN,im,  (4.36) 

P^y  (  ^  m  7"m  ^  rn  v  4"  ^m^mj\r)^m  3  K  1rlTl  m  v  .S  tTi  .S  ,  rl  —  3(:^Sm  3u7^Sm.  (4.37) 

The  rotation  about  the  line  of  contact  is  the  dominant  term  in  the  normal  accel¬ 
eration  and  jerk  of  the  moving  point. 

The  tangential  angular  velocity  and  angular  acceleration  perpendicular  to  the 
line  of  contact  are  obtained  from  (1.6)  and  (1.7): 

—  0,  €,j,  l o ^  27cm?zm^ s m  4“  Z/m^  2/cm?im/v  Ij rns rn.  (4.38) 

By  similar  reasoning  as  in  the  previous  case,  u>N  and  eN  are  free  variables. 

It  is  often  desired  for  a  robot  to  rotate  an  object  while  the  object  avoids  hitting 
some  obstacle  which  can  be  modeled  as  a  planar  surface.  The  equations  developed 
above  are  the  limit  conditions  which  prevent  a  moving  body  from  breaking  into 
a  fixed  plane. 
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4.5  Two  line  contacts  between  surfaces 

This  section  extends  the  motion  constraints  for  single  line  contact  to  those  for 
two  line  contacts  (Figure  4.8). 

We  notice  from  the  previous  sections  that  with  one  line  contact,  the  motion  of 
a  rigid  body  is  not  completely  determined.  It  will  be  useful  for  path  planning 
and  motion  sensing  to  study  the  motion  of  a  rigid  body  with  two  line  contacts. 
An  example  of  this  occurs  when  a  body  is  in  contact  with  two  fingers  of  a  robot 
hand  (if  the  fingers  of  the  hand  have  a  fixed  relative  position  they  act  as  one 
rigid  body). 

Here  we  assume  a  moving  object  is  composed  of  two  rigidly  connected  developable 
ruled  surfaces.  We  order  the  contact  lines  and  call  them  line  1  and  line  2  (Fig. 
4.8),  and  use  subscript  j  to  indicate  that:  1)  the  variable  is  expressed  in  the 
reference  frame  j  associated  with  the  jth  contact  line,  and  2)  either  the  first  line 
or  the  second  line  can  be  substituted  into  the  equation  (Fig.  4.8).  We  consider 
that  the  “moving  body”  and  the  fingers  are  in  relative  motion  to  each  other,  and 
in  absolute  motion  relative  to  a  fixed  body,  f 2m,,  £m,,  Vmj  and  am,  are  variables 
associated  with  the  object’s  motion  with  respect  to  the  fixed  space:  Um)  and 
£m,  are  the  angular  velocity  and  the  angular  acceleration  of  the  moving  object, 
and  Vmj  and  amj  are  the  velocity  and  acceleration  of  the  jth  reference  point 
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relative  to  the  fixed  body.  Qjt£j,  V}  and  a}  are  the  variables  for  the  object’s 
motion  relative  to  the  jth  finger,  flyy,  and  a f}  are  these  variables  for  the 

jth  finger’s  motion  with  respect  to  the  fixed  body,  /cmj  and  nmj  are  the  geometric 
variables  associated  with  the  jth  contact  line  of  the  moving  object,  and  Kf}  and 
n/y  are  the  geometric  variables  associated  with  the  j,h  finger. 

From  the  velocity  relation  between  two  points  on  the  same  rigid  body  Vmi  = 
RVml  +  R(Q  x  r)  (where  r  is  a  position  vector  pointing  from  the  first  to  the 
second  moving  point),  we  have 


vn.T  +  Kt 
V,2,N 

vn.L+i,*.L 


=  R 


Vfl,T  V\,T 


U 


ml  ,7* 


+  RL  u»mllW  ,  (5.1) 


u ; 


ml 


where  tiy,T  is  from  (2.2) 
1 


vi,T  = 


[(^my^  Ujj<T)  +  (Kmjnmj,N  Kfinf},N  )•*/;]•  (^-2) 


We  have  the  relation  flm2  =  RUmi.  If  R  =  [/?iy]sxs,  then  from  (1.6)  wm2,T  = 
/?i2 wmliN  +  Pl3u)ml  L  —  0.  When  the  x  axis  of  the  second  frame  is  not  parallel 
to  that  of  the  first  frame,  wmiiN  and  Vmi,L  are  not  independent,  and  we  have 
wm2,t  =  /?32w mi, N  +  From  the  first  two  rows  of  equation  (1),  we  can 

solve  for  the  unknown  motion  variables  associated  with  the  first  contact  line. 


Substituting  the  acceleration  relation  between  two  moving  points  on  the  same 
rigid  body,  am2  =  Raml  4-  R(S  x  r)  +  R[Qml  x  (ftml  x  r)j,  we  have 


®/2,T  "h  ®2,T  ~  ^^2,NU;/2,L 
af2,N  "h  ®2 ,N  d"  ^l,TW/3,l 

"h  ®2 ,L  ^(^2,JVU,/2,T  _  ^a.T^/a.w)  . 
an,s  +  \n  + 

at\,L  ®i ,l  'h  —  ^i.rw/i,yv)  , 


+  RB  nml  +  RC. 


(5.3) 


The  expressions  aJT,a}L  and  a}  N  are  from  (2.12)-(2. 14): 


■  *.»'**«  *»*»i'*i 
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^J-L  ~  VJ.L  WJ.N  (^J.L  KfjnJ},N  V].T  )> 

1  -2  1  2  2 
°),N  ~  AT  ft  Kn»jKJjnmj,Nnfj,NVjtT  Kfjnf},NUJj,LVj,T' 

and  Vj iT  in  (4.4)  can  be  obtained  from  (2.7)  as 


*,J'T  „  n  [AjSyj  +  (J  L  +  2«mj nm]  N  Lf]  x vL 

KmjnmjiN  (5  7) 

"b  {KmjTmjhrnjN  +  KmJnmj,N)imj  —  ( KJjTf3^fj,N  4”  KJj  nfj,N  )*  jj  ]  • 

B  and  C  in  (3)  are  two  matrix  expressions  in  (3.6.6)  and  (3.6.10). 

Similarly,  we  have  the  relation  £m2  =  R£m\ ,  and  the  relation,  from  (1.7),  fm2,r  = 
Pi2*mi,N  +  0ia*mi,L  —  0-  When  the  x  axis  of  the  second  frame  is  not  parallel 
to  that  of  the  first  frame,  cmliA,  and  fmiiL  are  not  independent,  and  we  have 
fm2,L  =  +  P^m\,L-  From  the  first  two  rows  of  equation  (2),  we  can 

solve  for  the  unknown  motion  variables  associated  with  the  first  contact  line. 
Hence,  all  the  quantities  for  a  complete  second  order  motion  description  are 
determined. 

When  the  moving  body  is  reduced  to  two  lines,  at  each  reference  frame  we  know 
u>JiT  =  0  (4.5),  and  from  a  tactile  sensor  reading  we  also  know  ujjn  =  LfT j. 
Hence,  we  can  determine  the  complete  angular  velocity  from  flm2  =  Af2ml .  We 
already  know  vJiN  =  0,  from  (4.2)  we  also  know  vJ  T  =  Sj},  by  using  the  velocity 
transformation  between  the  two  moving  points  we  can  completely  determine  the 
first  order  motion  variables.  By  a  similar  argument,  we  can  determine  the  second 
order  motion  variables. 

When  the  moving  body  is  reduced  to  two  planes,  in  addition  to  uJT  =  0,  we 
know  ujjtL  =  Sfj  from  (3.19).  By  virtue  of  the  angular  velocity  transformation 
between  two  reference  frames,  we  can  determine  the  complete  angular  velocity. 
If  vhL  is  not  obtainable  from  tactile  sensors,  we  have  to  have  a  third  contact, 
and  then  we  can  obtain  the  velocity  of  the  first  moving  point  from  the  condition 
that  the  relative  normal  velocities  all  vanish.  The  second  order  motion  variables 
are  similarly  obtainable. 


5*5 
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When  the  moving  body  is  reduced  to  a  line  and  a  plane,  or  a  line  and  a  general 
developable  ruled  surface,  or  a  plane  and  a  general  ruled  surface,  we  can  generally 
determine  all  the  motion  variables  using  only  two  line  contacts. 

This  completes  our  study  of  the  kinematics  of  spatial  motion  with  line  contact.  In 
the  next  chapter  we  study  control  schemes  which  can  be  used  to  control  a  robot’s 
motion  variables  so  that  they  satisfy  the  kinematic  relationships  developed  in  this 
and  earlier  chapters. 


mm 


Chapter  5 


A  CONTROL  FORMULATION 

FOR  CONTACT 


The  previous  three  chapters  are  focused  on  contact  kinematics.  The  relationships 
we  obtained  are  useful  for  path  planning,  especially  when  the  hardware  includes 
tactile  sensors.  The  relationships  we  obtained  for  the  moving  point’s  trajectory 
are  useful  in  implementing  robot  position  and  force  control.  Robot  control  for¬ 
mulations  can  be  written  in  terms  of  many  different  variables.  In  our  study,  in 
this  chapter,  we  use  and  extend  the  so-called  “operational  space  control.” 

Under  operational  space  control,  if  the  control  gain  matrices  are  diagonal,  the 
motion-error  equations  in  that  space  will  be  decoupled  [Khatib,  ’80;  Khatib  and 
Burdick,  ’8G].  However,  in  this  formulation  the  control  frame  (the  frame  which 
spans  the  operational  space)  remains  unchanged  along  the  entire  trajectory.  The 
operational  space  frame  should  not  be  confused  with  the  so-called  task  frames 
[Mason,  ’81;  Raibert  and  Craig,  ’81];  it  is  important  to  note  that  task  frames 
are  used  to  obtain  motion  specifications  and  are  not  control  frames.  In  con¬ 
ventional  operational  space  control,  the  normal  acceleration  at  iiie  contact  is 
ignored.  Hence,  in  operational  space  control  under  environmental  contact,  the 
control  error  is  not  necessarily  directly  meaningful  to  the  task  (since  the  oper¬ 
ational  frames  are  not  necessarily  parallel  to  the  task  frames),  and  the  applied 
control  force  may  not  be  accurate  (since  inertial  forces  due  to  normal  accelera¬ 
tion  are  neglected).  Therefore,  we  propose  the  use  of  task  space  control  with  the 
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inclusion  of  normal  acceleration.  Although  this  is  at  the  cost  of  additional  com¬ 
putation,  it  is  worthwhile  for  manipulators  under  force  control  when  the  contact 
points  vary  with  respect  to  the  moving  body. 

In  this  chapter,  we  discuss  operational  space  coordinates  and  task  space  vari¬ 
ables,  control  law  formulation  in  task  variables,  a  motion  compatibility  filter, 
the  calculation  of  the  manipulator’s  dynamic  model  for  a  task  space  from  the 
model  in  other  reference  systems,  an  efficient  scheme  for  obtaining  the  Jacobian 
matrix  inverse  for  calculating  the  dynamics  model,  and  an  extension  to  multiple 
finger  contacts.  With  regard  to  sensing  and  applying  static  forces,  we  discuss  the 
number  of  force  unknowns  at  one  contact  and  the  use  of  force  for  manipulation. 

Contact  stability  is  not  considered  in  this  dissertation. 

5.1  Operational  coordinates  and  task  variables 

The  operational  space  coordinates  can  be  any  set  of  independent  variables  of 
interest  in  an  operation.  For  the  end-effector  of  a  spatial  manipulator,  we  usually 
are  interested  in  a  reference  point  and  the  orientation,  so  the  operational  space 
coordinates  can  be  taken  as  the  coordinates  of  the  point,  a  unit  vector  directed 
from  the  point,  and  a  rotation  angle  about  this  vector.  Sometimes  we  wish 
to  consider  the  position  of  the  elbow  and  only  some  of  the  parameters  of  the 
end-effector,  etc..  The  coordinates  can  be  Cartesian,  spherical,  or  cylindrical 
coordinates,  or  even  be  associated  with  a  frame  with  three  skew  axes. 

Although  the  operational  space  coordinates  can  be  quite  general,  for  a  typical 
contact  task  where  a  contact  point  varies  with  respect  to  the  moving  surface, 
the  trajectory’s  reference  point  and  the  task  point  are  not  the  same.  This  is  also 
true  when  there  are  multiple  contacts  with  varying  contact  normals  on  the  end- 
effector  or  component  links.  As  in  Fig.  5.1,  let  us  assume  the  original  reference 
frame  is  O,  and  the  current  task  frame  is  P.  Usually,  the  desired  stiffness  matrix 
will  be  diagonal  when  specified  with  respect  to  the  current  task  frame.  If  we  map 
this  into  a  stiffness  matrix  with  respect  to  the  original  reference  frame,  the  new 
matrix  is  not  diagonal.  Hence,  there  will  no  longer  be  a  decoupling  of  motion 
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Figure  5.1  Original  reference  frame  and  task  frame 

errors.  It  follows  that  we  desire  to  control  in  terms  of  a  varying  “operational 
space”  in  order  to  maintain  the  error  decoupling  feature.  That  is,  for  each  (tiny) 
segment  of  a  trajectory  we  let  the  current  “operational  space”  to  be  the  task 
space. 

The  task  variables  associated  with  contact  can  be  specified  depending  on  the 
types  of  contact:  point  contact,  line  contact  or  planar  contact.  Many  contact¬ 
ing  situations  (such  as  a  peg  insertion)  can  be  reduced  to  these  types  or  their 
combinations. 

For  point  contact,  the  task  variable  is  naturally  associated  with  the  distance 
along  the  contact  normal.  Lot  us  denote,  for  the  ith  contact  point,  the  surface 
normal  n„  and  a  position  vector  p,  which  is  directed  from  the  instantaneous 
contact  point  on  the  fixed  body  to  the  contact  point  in  the  moving  body.  The 
requirements  for  maintaining  the  point  contact  are  that  the  normal  c  mponcnts 
of  p,  and  p,  vanish,  and  that  the  normal  component  of  p,  has  a  specific  value  p 
pt,  is  determined  by  the  angular  and  sliding  velocities  of  the  moving  body  and 
the  surface  curvatures  at  the  contact,  using  formulae  which  have  been  obtained 
in  previous  chapters.  Thus 

x{  =  n,  •  Pi  =  0,  i,  =  n,  •  p,  =  0,  x,  =  n,  •  p,  =  p2t.  (1.1) 

While  the  expression  for  depends  on  the  geometries  of  both  surfaces  at  the 
contact,  it  is  actually  calculable  from  the  moving  surface  geometry  and  tactile 
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Figure  5.2  Moving  body  connected  to  a  manipulator  with  force  and  position  sensors 

sensor  readings.  By  tactile  sensing  -  from  either  a  tactile  sensor  or  one  force 
sensor  we  can  determine  the  moving  contact  velocity  im  and  ym  (assuming  the 
inertia  force  between  the  contact  point  and  sensing  point  is  negligible;  otherwise 
we  need  two  force  sensors*).  From  the  position  sensors  (such  as  optical  encoders 
at  joints  of  a  manipulator),  we  can  determine  the  sliding  velocity  and  angular 
velocity  of  the  moving  body  (Fig.  5.2).  Thus,  from  (3.1.21)  and  (3.1.21).  we  can 
determine  the  contact  velocity  on  the  fixed  surface:  x )  —  ~  im,  y}  —  v7  —  ym. 

Substituting  (3.1.18),  (3.1.10)  and  (3.1.19)  into  (3.1.37),  wc  obtain  the  normal 
acceleration  of  the  moving  point 

Pi  (^'m.jc^'m  T  Pm2/m)(^m  T  3?  y  )  ~~  (f/m^m  T  ^ m,yV rn'lilj m  T  1//) 

.  ,  (12) 

-  w,  yf  +  u>2Xj  +  2{xrnu)7  -  ymu>, ). 

For  the  case  where  the  moving  surface  becomes  a  point,  from  (3/1.1) 

Pi  =  -kf,xv i  -  2gfv]v7  -  k}  vvl  =  -  w/yt>2. 

Here,  ujfx  and  u)fy  are  the  x  and  y  components  of  the  angular  velocity  of  the 
contact  normal  on  the  fixed  surface.  If  by  use  of  a  force  sensor  we  can  accurately 

*  We  assume  here  that  a  dynamics  model  is  valid  for  the  members  between  the 
contact  point  and  the  force  sensors. 
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determine  the  contact  normal  of  the  fixed  surface,  we  are  able  to  determine  u>Jx 
and  u>fy. 

For  planar  motion  with  point  contact  between  two  curves,  from  (2.2.9)  and 
(2.2.28)  we  obtain 


N  '  Pi  UJX  j  2  X  rnUJ  X.m(  X  f  )£m, 

and  when  the  moving  curve  becomes  a  point 

TV,  •  p,  =  -u>f  v, 

where  Uj  is  the  angular  velocity  of  the  contact  normal  on  the  fixed  curve. 

For  a  line  contact  between  two  developable  ruled  surfaces,  as  pointed  out  in 
Chapter  4,  there  are  three  pairs  of  independent  scalar  constraints  on  the  first 
order  and  second  order  properties  of  the  motion.  One  pair  of  constraints  is 
on  the  normal  components  of  the  velocity  and  the  acceleration  of  a  reference 
point  on  the  contact  line  of  the  moving  surface.  One  pair  of  constraints  is  on 
the  angular  velocity  and  angular  acceleration  along  a  direction  perpendicular  to 
both  the  contact  line  and  the  surface  normal,  and,  the  third  pair  is  on  the  normal 
components  of  the  angular  velocity  and  the  angular  acceleration  (this  constraint 
diminishes  when  the  fixed  surface  is  planar). 

Similarly,  for  a  planar  contact  there  are  three  sets  of  constraints.  One  set  is  on 
the  normal  distance  of  a  reference  point  in  the  plane,  and  the  other  two  can  be 
on  the  rotations  about  tangential  axes. 

Except  for  the  normal  angular  velocity  under  line  contact,  all  first-order  con¬ 
straints  for  contact  can  be  replaced  by  static  force  constraints.  The  null  normal 
velocity  for  a  point  contact  will  be  guaranteed  by  the  presence  of  an  appropriate 
normal  contact  force.  The  sufficient  condition  for  maintaining  a  line  contact  is 
that  the  resultant  normal  force  acts  on  the  contact  line  in  a  sense  to  maintain 
contact,  or  that  there  are  normal  forces  of  sufficient  magnitude  and  sense  at  two 
different  reference  points  on  the  line.  The  sufficient  condition  for  a  planar  contact 
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is  that  the  resultant  normal  force  acts  on  the  contact  plane  in  the  appropriate 
sense,  or  t  hat  there  are  sufficiently  large  normal  forces  at  three  different  reference 
points  in  the  plane. 

When  used  for  obstacle  avoidance,  the  constraints  on  contact  velocity  and  con¬ 
tact  acceleration  become  inequalities.  When  the  motion  produced  by  the  other 
control  variables  does  not  satisfy  the  inequality  constraints,  we  need  to  add  these 
constraints  to  our  controller,  otherwise  these  inequalities  serve  simply  as  condi¬ 
tions  which  need  to  be  checked  for  satisfaction. 

5.2  Control  in  task  variable  space 

In  each  small  time  interval,  a  model  based  manipulator  control  law  [Khatib  and 
Burdick,  ’86]  can  be  directly  applied  to  the  task  variables  .V: 

t  =  JtF  =  JT[Mt(X *  +  KJX  +  KP6X)  +  Nt  +  Fcnntrol}.  (2.1) 

In  this  equation,  r  is  a  command  vector  for  joint  torques;  J  and  M,  are  the 
Jacobian  matrix  and  inertia  matrix  corresponding  to  the  task  space;  A'*  is  the 
acceleration  vector;  A’„  and  Kp  are  diagonal  gain  matrices  for  controlling  task 
space  velocity  and  position;  A",  is  the  vector  of  nonlinear  velocity  dependent 
inertia  forces;  the  vector  Fconiroi  is  the  force  applied  to  the  environment. 

For  each  task  variable,  vvc  either  control  force  or  position.  In  force-controlled 
directions,  if  we  can  physically  measure  the  accelerations,  we  use  the  actual 
acceleration  components  for  A'*,  whereas  in  position-controlled  directions  and 
for  unmeasured  acceleration  directions  we  use  the  desired  acceleration.  The 
Jacobian  matrix  can  be  formulated  as  follows.  The  velocities  along  the  force- 
controlled  directions,  XC1  can  be  expressed  as  Xc  =  Jc0.  Position-controlled 
variables  (other  than  the  contact  task  variables),  Xm,  can  be  expressed  as  Xm  = 
JmQ.  Combining  both,  we  have  a  complete  set  of  task  velocity  variables  X  = 
[XJ ,  X^T  and  the  Jacobian  matrix  J  =  [JJ,  J„]T- 

Under  the  assumption  that  all  desired  force  contacts  are  taking  place,  and  there 
is  zero  velocity  associated  with  these  directions,  we  can  determine  from  Jc  if 
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there  is  any  mobility  for  the  manipulator  under  the  current  constraints.  If  |  Jr|  is 
a  square  matrix  of  full  rank,  then  a  vector  of  zero  joint  rates  is  the  only  solution. 
Alternatively,  if  a  unit  screw  associated  with  a  contact  normal  is  reciprocal  to 
all  the  unit  screws  associated  with  the  joint  axes,  that  contact  direction  is  un¬ 
controllable  and  does  not  impose  any  restriction  on  the  joint  rates.  In  such  a 
case,  if  the  contact  constraint  is  redundant  instantaneously,  the  rank  of  Jr  will 
be  reduced  by  one. 

Mt  is  a  square  inertia  matrix  corresponding  to  the  set  of  task  variables.  It  is 
known  that  Mt  =  [JMglJT\~l  [Khatib,  ’80],  where  Mg  is  the  inertia  matrix  in 
joint  space.  If  0  is  the  joint  rate  vector  corresponding  to  the  minimum  kinetic 
energy  of  the  manipulator  under  the  constraint  X  =  J0,  M,  satisfies  the  relation 
XTMt  X  =  Q  MeO.  If  we  define  0  =  JX,  where  J  =  MflJTM,  [Khatib.  ’80], 
then  M,  =  JT  Mg J. 

The  control  law  in  (2.1)  can  be  partitioned  into  F  =  Fj,eg-jorwarg  +  Fjtrdu.-k .  a 
desired  feed-forward  command  force  and  an  error-control  force  based  on  feedback. 
The  Fl^d_lot  wari  =  MtXm  +Nt  +Fa ,  contains  the  inertial  forces  and  the  desired 
contact  force,  Fa,  while  FfeeJback  involves  the  motion  and  force  error  correction 
commands.  For  the  feed-forward  inert  ia  forces,  since  r  =  JT  F  and  F  —  J1  r  we 
have 

Tf^-f^arj  =  JT[MtXm  +  Nt]  =  JTJT(M0e  +  No),  (2.2) 

hence  JTJT  is  a  projector  which  maps  joint  inertia  forces  into  the  permissible 
torque  space.  For  a  non-redundant  manipulator  J  =  J-1,  and  the  feed-forward 
inertia  vectors  are  the  same  as  those  in  joint  space.  So  in  this  case,  only  the 
error-correction  vector  differs  between  controls  formulated  in  task  space  and  joint 
space. 

The  decoupling,  which  is  associated  with  the  diagonal  control  gain  matrices,  will 
remain  unchanged  in  the  presence  of  contact  forces  acting  in  arbitrary  direct  ions 
(This  is  of  course  provided  that  we  can  neglect  the  friction  at  the  contacts  and 
that  there  are  biased  contact  forces  applied  for  maintaining  the  contacts.  If  the 
effect  of  friction  is  not  negligible,  compensating  for  the  frictional  forces  in  the 
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control  law  will  also  help).  This  is  because  contact  wrench  and  motion  screws 
are  mutually  reciprocal,  and  no  mechanical  work  is  done  at  the  contact  Hence, 
the  contact  force  will  not  affect  the  motion  of  the  object,  although  the  motion 
dynamics  will  affect  the  contact  forces.  Lipkin  and  Duffy  [Lipkin  and  Duffy,  ’80] 
have  stressed  the  difference  between  reciprocity  and  orthogonality  for  contact 
forces  and  motion.  In  support  of  their  results  that  force  controlling  directions 
may  not  be  orthogonal  to  the  motion  directions,  assume  several  contact  forces 
are  at  different  points  and  exerted  in  different  directions,  with  resultant  force  f 
and  angular  velocity  ui  at  the  reference  frame  origin,  the  velocity  is  v  and  the 
resultant  moment  is  m,  the  screw  reciprocity  indicates  that  at  the  origin  of  the 
reference  frame 

f  •  v  +  m  •  ui  =  0.  (2.3) 

In  general  f  v  ^  0  and  m  •  uj  ^  0,  so  orthogonality  is  not  guaranteeded. 

Although  there  are  no  computations  needed  for  control  gains  (which  are  usu¬ 
ally  specified  in  task  frames)  lodel  based  control  in  task  space  requires  more 
computation  than  in  operational  space.  First,  there  is  the  need  for  trajectory 
mapping.  For  example,  assume  that  there  exists  a  task  point  A'2,  an  original 
reference  point  Xit  and  a  relationship  P0  +  RX2  =  AV  Here,  PQ  is  a  position 
vector  for  the  origin  of  the  task  frame  with  respect  to  the  reference  frame,  and 
R  is  a  rotation  matrix  from  the  task  frame  coordinates  to  the  reference  frame. 
Once  ATt  is  specified,  the  trajectory  with  respect  to  the  task  frame  becomes 
X2  —  PT(X-i  —  P0 ),  X2  =  RTXi,  and  A'2  =  RTX\-  Second,  there  is  a  need 
for  relatively  faster  updating  of  dynamics  parameters  than  for  controlling  in  an 
operational  space  system.  The  dynamics  parameters  are  usually  updated  at  a 
slower  rate  than  that  of  the  trajectory.  However,  if  these  are  updated  too  slowly, 
then  we  will  again  encounter  again  the  problems  mentioned  for  operational  space 
control. 

5.3  Motion  compatibility  filter 

When  the  accelerations  in  the  force  control  directions  are  know  n,  they  should  be 
included  in  the  controller  since  this  will  facilitate  smooth  force  control.  If  the 
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control  is  performed  directly  on  the  task  variables  or  if  the  task  point  and  the 
original  reference  point  are  coincident,  applying  the  so-called  motion  compatibil¬ 
ity  filter  to  the  error-correction  vector  is  equivalent  to  having  null  components  of 
Kp  and  A  „  matrices  in  the  force-control  directions.  We  can  also  have  a  compati¬ 
bility  filter  for  the  error-correction  vector  (on  velocity  and  force)  in  other  control 
spaces  when  the  contact  directions  are  given. 

Khatib  and  Burdick  [Khatib  and  Burdick,  ’86j  introduced  a  motion  compati¬ 
bility  filter  FlF^,  and  we  now  consider  it  under  the  assumption  that  the  task 
point  is  coincident  with  the  original  reference  point.  U  is  a  matrix  involving  two 
sub-matrices,  which  can  be  regarded  in  our  context  as  RJ  Rx  and  /?T  /?2. 

Rx  and  R2  are  two  rotation  matrices  relating  the  positional  and  rotational  op¬ 
erational  frames  to  the  analogous  task  frames.  Ylj  an^  are  unit  matrices 
but  with  null  elements  in  the  force-control  directions.  If  we  assume  F ^  is  of  the 
form  Xd  4-  KVSX  -f  Kp6X,  QXd  actually  filters  out  the  acceleration  along  the 
force-control  directions,  and  these  accelerations  do  not  necessarily  vanish. 


/  =  fd  +  k,  /  cdl  +  kpc  +  kve 


Figure  5.3  Free  body  diagram  for  single  mass  contact 

We  can  look  at  the  effect  of  normal  acceleration  on  force  control  through  the 
study  of  a  single  mass  contact.  As  in  Fig.  5.3,  we  define  /c,  fd  and  /;  to  be 
the  actual  contact  force,  desired  contact  force  and  the  inertia  force,  kp,  k,  and 
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ku  to  be  the  control  gains  for  a  PID  control  law,  and  the  contact-force  error 
to  be  e(t)  =  fd  —  fc ■  If  we  neglect  the  inertia  force  in  the  control  command 
f  —  fd  +  ki  J  edt  4-  kpe  4-  kve,  then  the  Laplace  transformations  for  the  actual 
contact  force  and  the  contact-force  error  are: 


Us)  =  fd- 


sfl 


s2kv  +  s(  14-  kp)  4-  k. 


,  e(s)  = 


sfi 


s7kv  4-  s(  1  H-  kp)  +  k. 


(3-1) 


For  a  general  PID  or  PI  controller,  there  will  be  a  static  error  in  contact  force 
with  magnitude  proportional  to  ft  whenever  it  is  a  ramp  signal,  and  for  a  PD 
controller  there  will  be  a  static  force  error  for  a  constant  //  signal.  If  we  consider 
the  dynamic  error  characteristics  of  contact  force,  the  /,  term  will  be  more 
significant  for  a  smooth  contact. 


For  error  control  vectors,  we  use  an  upper  bar  on  to  indicate  its  sub-matrix 
for  the  point’s  position,  and  use  subscripts  o  or  t  for  a  variable  to  indicate  that  it 
is  associated  either  with  the  operational  reference  frame  or  the  task  frame.  Then 


(flf  ^R^KpJX^  (Rl"£Ri)R?KptR16X0=  R?  £  Kpt6Xt.  (3.2) 


The  product  Ylf  Kpt  demands  that  the  components  of  Kpt  along  force-control 
directions  vanish.  An  analogous  result  is  true  for  the  rotation  part.  Hence,  the 
explicit  calculation  of  such  a  filter  at  run-time  is  not  necessary,  since  we  can 
simply  let  the  corresponding  components  of  Kp  and  A'„  vanish. 


We  now  consider  a  general  compatibility  filters  for  velocity  and  force,  such  filters 
become  necessary  when  control  is  performed  in  other  than  task  space.  We  assume 
the  contacting  surface  normals  are  known,  since  these  can  be  obtained  from  force 
sensor  information. 


When  there  are  multiple  contacts  on  different  links,  we  can  almost  directly  use 
the  joint-space  filters  proposed  by  West  and  Asada  [West  and  Asada,  ’85],  The 
differences  are  that  we  can  assume  the  control  directions  are  already  in  the  “es¬ 
sential  work  space,”  and  that  instead  of  a  rigidly  fixed  point  each  contact  can 
have  relative  motion.  The  filter  is  derived  by  substituting  Jc ,  in  which  each 


3 


ri 


5 

I 

u. 

»l 

r.1 


a 


s 

l», 

*• 

>• 


a 


114  Chapter  5:  A  Control  Formulation  for  Contact 


row  represents  a  constraint  associated  with  a  contact,  into  the  filter  expressions 
developed  by  West  and  Asada. 

When  all  contacts  are  on  one  rigid  body  in  spatial  motion,  we  apply  a  similar 
procedure  to  the  one  used  by  West  and  Asada.  Assume  that  the  control  variables 
X0  are  related  to  the  contact  variables  Xc  by  a  transformation  matrix  Tc,  Xr  = 
TCX0  =  0.  To  satisfy  this  equation 

X0  =  (I-Tc+Tc)a,  (3.3) 

where  a  is  an  arbitrary  scalar,  and  Tc+  is  a  1,2-inverse  [Ben-Israel,  et.  al,  ’74] 
of  Tc.  (/  —  Tc+Tc)  is  a  projector,  hence  a  compatibility  filter  for  velocity.  From 
FJX0  =  F,r(J  -  T+Tc)y  =  0,  we  obtain 

F0  =  (TC+TC)6,  (3.4) 

where  b  is  an  arbitrary  scalar.  T+Tc  is  an  orthogonal  projector  or  a  compatibility 
filter  for  force.  We  notice  that  the  velocity  component  along  a  line  in  a  rigid  body 
is  the  the  same  for  every  point  on  the  line.  Hence,  each  row  of  Tc  depends  only 
on  the  corresponding  axis  associated  with  a  contacting  normal. 

5.4  Transformation  of  dynamics  parameters 

We  now  consider  the  case  that  a  preplanned  trajectory  of  a  moving  body  is 
associated  with  one  reference  point  and  the  task  variables  are  associated  with 
another  point  (for  example,  the  varying  contact  point  on  the  moving  body). 
Given  the  parameters  of  dynamics  model  associated  with  a  reference  frame,  those 
for  the  task  frame  can  be  simple  to  calculate.  If  there  exists  only  an  orientation 
difference  between  the  reference  frame  and  the  task  frame,  then  controlling  in 
the  reference  frame  and  in  the  task  frame  are  equivalent  provided  their  control 
gains  are  interchangeable. 

We  use  subscripts  o  and  i  to  denote  variables  which  are  associated  with  the 
reference  frame  and  the  task  frame,  respectively.  Assume  that  T  is  a  transforma¬ 
tion  matrix  which  relates  the  velocities  of  the  two  reference  frames:  X,  =  TXa 
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(X<  =  [ut,  w,]T  and  X0  =  [t’0,  u>0]r).  Then 

Mt=T-TM0T~\  (4.1) 

Nt  =  T-t[N0  -  M0T~lC],  (4.2) 

Ft=T~'F0,  (4.3) 

where  C  is  a  vector  of  the  centrifugal  acceleration  between  the  two  points. 

If  we  assume  that  the  point  velocity  and  the  angular  velocity  are  expressed  with 
respect  to  two  different  sots  of  frames,  and  the  distance  between  the  reference 
point  and  the  task  point  vanishes,  T  =  diagonal(Ri ,  f?2).  =  TAt0TT,  N,  = 

TNa,  and  Ft  =  TF0.  Based  on  these,  the  motion  expression  in  (2.1)  satisfies 

Jj[M0X0d  +  K0JX0  +  K0P6X0]  =  J?[MtXtd  +  Ktv6Xt  +  Ktp6Xt],  (4.4) 

as  long  as  we  take  Kop  =  TT KlpT  and  Kov  —  TT KtvT.  The  control  in  the  fixed 

reference  frame  will  now  lead  to  decoupled  error  equation  in  task  variable  space. 

For  a  general  coordinate  transformation  between  two  sets  of  variables  of  equal 
number,  (1)  and  (3)  are  still  valid,  except  in  (2)  N,  =  T~T(N0  —  M0T~lTX0), 
where  T  is  to  be  determined  from  Xt  =  TX„  +  TX0. 


5.5  An  efficient  inverse  of  the  Jacobian  matrix 

As  shown  before,  for  a  non-rcdundant  general  manipulator  with  environmental 
contact,  the  inertia  matrix  in  a  reference  frame  can  be  treated  as  directly  related 
to  the  inverse  Jacobian-matrix.  Generally  the  reference  point  is  not  at  the  wrist 
point,  and  the  last  three  joints  have  motion  as  well,  so  the  Jacobian  matrix  has  no 
three- by- three  zero  sub-matrix.  However,  for  a  manipulator,  such  as  the  PUMA, 
in  which  the  last  three  joint  axes  intersect  at  the  wrist  point,  the  job  can  be 
broken  down  to  two  simple  three-by-three  matrix  inverses  plus  several  matrix 
transformations  and  multiplication. 

As  in  Fig.  5.4,  from  the  wrist  frame  to  the  reference  frame, 

V0  =  Rx  Vw  +  Rx  [n„  x  r],  Q0  =  R2QW 
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Figure  5.4  Wrist  frame  and  a  reference  frame 


where  the  subscript  o  (or  tv)  denotes  that  a  variable  is  with  respect  to  the  refer¬ 
ence  frame  (or  the  wrist  frame),  and  r  is  a  position  vector  from  the  wrist  point 
to  the  reference  point.  In  matrix  form  the  above  expressions  become 


(v0\_(Rt  p\(vw\ 
[nj  Vo  r2)\qw)- 


Here,  Rt  is  a  coordinate  rotation  transformation  matrix  from  the  positional  wrist 
frame  to  the  positional  reference  frame  and  R2  is  the  analogous  matrix  for  the 
rotational  wrist  frame  to  the  rotational  reference  frame,  and  O  a  three- by- three 
null  matrix.  The  velocity  and  angular  velocity  at  the  wrist  frame  can  be  expressed 
in  a  standard  way, 

(a -K  ih 

where  J,  is  a  three-by-three  matrix.  If  we  define  J  to  be  the  Jacobian  matrix 
relating  the  reference  velocity  to  joint  rates, 


(S)-(S  Oft 


(5.1) 


Now  J  is  expressed  as  a  product  of  two  6  by  6  matrixes,  and  each  one  includes  a 
null  off-diagonal  sub-matrix.  By  standard  calculation  the  inverse  of  J  becomes 
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where  A  =  —  J3l  J2Jt  1 ,  B  =  —  R^PR*.  This  gives  an  efficient  way  to  calculate 
the  inverse. 

For  a  general  non-redundant  manipulator  with  environmental  contacts,  the  Jaco¬ 
bian  matrix  still  can  be  divided  into  sub-matrices,  with  J{  and  Ji  square  matrices 


/J,  J2\ 

~\Ja  Jj- 


If  J,  1  exists,  we  have  from  [Kailath,  ’80], 

where  A  =  J4  —  JjJ,-lJ2,  E  =  Jf*  J2  and  F  =  J3J ,~l.  If  J4~*  exists,  the  (1,1) 
block  element  of  the  inverse  can  be  written  as  [Jj  —  J2J4-1  J3]~' .  If  J2-1  exists, 
similarly  we  can  obtain 

(  -A~l  J4J2_1  A-1  \ 

J  "  ^j2-|(/  +  j1a-|j4j2-!)  -/-’y.A-1/’  '  > 

where  A  =  J3  —  J4J2_1  J 
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Figure  5.5  Multiple  fingers  in  grasping 
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5.6  On  extension  to  grasping 

Model  based  control  can  be  extended  to  grasping  (Fig.  5.5),  since  force-controlled 
variables  can  be  associated  with  internal  grasping  forces,  and  the  grasped  object 
and  fingers  can  be  considered  as  a  complete  system. 

The  internal  forces  when  simultaneously  applied,  produce  zero  work  if  we  neglect 
sliding.  Under  this  assumption,  the  control  of  internal  force  will  not  affect  the 
decoupling  of  error-correction  terms  in  the  motion  controller. 

Since  the  motions  of  the  fingers  and  that  of  the  grasped  object  interact  with  each 
other,  the  decoupling  of  the  error-correction  terms  will  be  affected  if  we  isolate 
the  dynamics  of  the  moving  body.  Assume  an  object  is  supported,  through  point 
contacts  without  slipping,  by  a  group  moving  fingers  and  is  capable  of  spatial 
motion  X  —  [Vt,  fi,]7"  (the  velocity  at  a  reference  point  and  the  angular  velocity 
of  the  object).  If  we  consider  only  the  moving  object,  the  driving  force  becomes 

Mb(X  +  KV6X  4-  KP6X)  +  Nb  +  Fcontrol.  (6.1) 

Here,  Mb  is  the  inertia  matrix  for  the  grasped  object,  and  Nb  is  its  non-linear 
inertia  force  (it  vanishes  if  X  is  associated  with  the  object’s  mass  center).  Assume 
each  finger’s  inertia  force  has  been  balanced,  we  encounter  the  problem  of  how  to 
treat  the  finger-tip  forces  from  Mb{  h\fX  +  Kp6X):  without  the  premultiplication 
of  a  finger’s  equivalent  inertia  matrix,  the  response  will  be  slow  since  the  finger’s 
tip  has  different  acceleration  responses  to  its  different  joint  torques.  However, 
if  we  premultiply  the  command  force  at  the  finger  tip  by  the  equivalent  inertia 
matrix  of  the  finger,  the  decoupling  of  the  error-correcting  terms  for  the  moving 
body  will  be  affected. 

Hence,  we  need  to  consider  the  moving  body  and  its  supporting  fingers  together 
as  a  system,  for  which  we  change  the  subscripts  6  to  a  in  (1),  and  M ,  and  N,  can 
be  obtained  as  follows.  We  denote  v,  as  the  velocity  vector  at  the  i"1  contact 
point,  V,  =  WjX,  and  W,  =  \RlL{ r,),  /?,].  Here,  R,  is  a  rotation  coordinate 
transformation  matrix  from  the  reference  frame  to  the  ith  contact  frame,  and 
£(r,)  is  a  matrix  resulting  from  Clt  x  r,  =  L{ r,)fi(,  where  r,  is  a  position  vector 
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from  the  reference  point  to  the  ith  contact  point.  On  the  other  hand,  from  the 
link  Jacobian  matrix  we  have  v,  =  J,0,.  Redundant  fingers  could  be  treated 
on  the  basis  that  the  minimum  kinetic  energy  of  the  system  corresponds  to  the 
minimum  kinetic  energy  for  each  finger,  we  assume  each  finger  is  non-redundant: 
0,  =  J~lWtX.  The  resultant  force  on  the  moving  body  can  be  expressed  as 
the  sum  where  F;  =  W~T J~T rt.  Based  on  these  the  system’s  inertia 

matrix,  M,,  becomes 

M,  =  W?J~TM,  +  W?J~tM2J-'  W7  +  •  ■  •  +  \V„J~TMnJ~l\Vn  +  Mh. 

(6.2) 

If  we  consider  the  acceleration  at  the  contact  point  on  the  moving  body:  J,G>i  + 
J,0,  +  ar,  +  act  =  W,X  +  C,;  0,  =  J~l  [IT, A'  +  C,  -  j,Q,  -  ar,  -  ac,].  In  this 
expression,  ar;  and  ac,  are  the  relative  acceleration  and  the  Coriolis  acceleration 
of  the  contact  point  on  the  moving  object  with  respect  to  that  of  the  ith  finger, 
and  C,  =  R,[ Qt  x  (IT,- A'’)].  Mapping  the  inertia  torques  A/,0,  +  NQ.  in  joint 
coordinates  into  the  inertia  force  on  moving  object’s  reference  system,  we  obtain 

n 

N,  =  Nb  +  Y^N«  (6.3) 

1=  I 

where  N,  =  WtT J~T[Ne,  +  M,J~l(C ,  -  J,0,  -  ar,  -  ac,)). 

While  Mb[Xd  +  KP6X  +  KV6X ]  +  Nb  can  be  distributed  among  finger  tips  with 
redundancy,  the  [W^ J~T M,J~lW,]X  +  Nx  naturally  should  be  assigned  back 
to  the  corresponding  finger,  since  no  additional  force  transmission  through  the 
contact  point  is  necessary.  This  part  can  be  assigned  as  M,J~' (W,X  +  C,  — 
J,0,  — ar,  — ac,)  +  /V0i  in  the  ith  finger’s  joint  space.  For  the  error-correcting  term, 
similarly,  we  can  assign  Mi  J~l  W\KP6 X  +  KV6X]  =  r,  back  to  the  corresponding 
finger.  This  makes  the  error-correcting  force  on  the  moving  body  proportional 
to  each  finger’s  inertia,  and  it  is  this  term  which  makes  a  difference  between 
defining  a  system  by  considering  the  moving  body  only  and  considering  both  the 
moving  body  and  the  supporting  fingers. 

When  an  object  is  operated  by  n  fingers  (manipulators)  through  rigid  grasping, 
we  have  directly  X  =  Jx  0t  =  J202  •  •  -  =  JnOn,  and  the  previous  expressions  can 
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be  much  simplified.  When  there  is  slipping  at  the  contact  point,  we  can  include 
the  slipping  component  into  a  “joint  rate”  vector,  and  the  inverse  of  the  Jacobian 
matrix  J,  becomes  a  generalized  inverse.  If  a  desired  sliding  velocity  is  specified, 
such  inverses  are  deterministic. 

5.7  Number  oi  force  unknowns  at  one  contact 


In  dealing  with  multiple  contacts,  we  encounter  the  problem  of  force  sensing.  We 
now  consider  how  many  force  unknowns  are  present  for  one  point  contact,  line 
contact  or  planar  contact,  when  certain  pre-conditions  have  been  given.  This  is 
useful  in  the  selection  of  force  sensors. 

For  a  point  contact  the  contact  force  must  lie  on  the  friction  cone,  with  tangential 
component  opposite  to  the  sliding  direction.  Given  the  contact  point  position, 
if  we  know  the  coefficient  of  friction  p  there  is  1  unknown  associated  with  the 
magnitude  of  the  force;  otherwise  there  are  2  unknowns,  the  extra  one  is  for  p. 
When  there  is  no  sliding  the  axis  of  the  contact  force  must  lie  within  the  friction 
cone,  so  there  are  3  unknowns  for  the  force  vector  acting  at  the  given  point. 
When  the  contact  point  is  simply  confined  on  a  line,  or  a  plane,  we  need  to  add 
1  or  2  extra  unknowns  for  the  location  of  the  contact  point.  If  the  frictional 
torque  about  the  contact  normal  is  also  significant,  one  more  unknown  needs  to 
be  added. 

For  a  line  contact  between  two  cylindrical  surfaces  without  rotation  about  the 
normal  at  the  contact,  when  given  p  there  are  2  unknowns  (one  for  the  location 
of  the  resultant  force  and  the  other  for  the  force  magnitude),  otherwise  there 
are  3  unknowns.  For  general  developable  ruled  surfaces  we  have  5  unknowns  if 
there  is  no  sliding  along  the  line  of  contact,  since  we  know  only  that  the  resultant 
wrench  will  pass  through  the  line  of  contact.  If  there  is  frictional  torque  about 
the  line  of  contact,  we  need  to  add  one  more  unknown. 

The  planar  contact  can  be  treated  in  a  similar  manr.?’-  For  a  pure  translation, 
when  p  is  given  there  are  3  unknowns  associated  with  the  acting  point  of  the 
resultant  force  in  the  plane  and  the  magnitude  of  the  force,  otherwise  there  are 
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4  unknowns.  If  there  is  rotation  as  well,  then  there  will  he  6  unknowns  if  the 
pressure  distribution  is  an  unknown. 


When  no  conditions  are  specified  there  will  be  6  unknowns  associated  with  the 
force  and  moment  at  a  point  contact,  line  contact  and  planar  contact. 


5.8  Contact  force  manipulability 


Relative  to  static  force  application,  we  consider  force  manipulability  for  a  non- 
redundant  and  a  redundant  spatial  manipulator,  and  discuss  the  “optimal'’  arm 
configuration  based  on  force  manipulability  in  all  or  some  directions. 


When  a  manipulator  performs  operations  where  the  force  application  at  the 
end-effector  becomes  significant,  we  need  to  consider  its  force  manipulability  as 
opposed  to  its  kinematic  manipulability  [Yoshikawa,  ’85]. 


For  a  non-redundant  manipulator,  from  A”  =  JQ  we  have 


XTX  =  qtjtjq. 


We  define  U  =  0/ yj XT X /0r0  which  represents  an  ellipsoid  in  variable  U. 
The  volume  index  of  the  ellipsoid,  |«/|,  has  been  referred  to  as  the  measure  for 
kinematic  manipulability  [Yoshikawa,  ’85].  On  the  other  hand,  from  r  =  JT F 


we  have 


ttt  =  FtJJtF. 


If  we  define  U  =  Fj y/FT F/ttt,  it  also  represents  an  ellipsoid  in  variable  U. 
Since  the  eigenvalues  of  J  JT  and  JTJ  are  the  same  -  both  ellipsoids  are  of  the 
same  shape,  hence  we  can  also  regard  j  J\  as  the  measure  for  force  manipulability. 


For  a  2-joint  planar  manipulator,  the  differential  area  <5<?,<502  >n  joint  space  will 
be  mapped  to  6x6y  =  \J\86\807  at  the  end  effector.  At  the  same  time,  if  there 
are  forces  f z  and  fy  exerted  at  the  end-effector,  the  fxfy  area  in  force  space  will 
be  mapped  to  r,r2  =  \J\fxfy  in  joint  torque  space.  The  analogous  result  is  true 
for  an  n-degrees-of-freedom  manipulator  if  we  consider  the  n-dimensional  volume 
in  force  and  motion  spaces. 
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In  terms  of  arbitrary  directions,  the  maximum  |J|  corresponds  to  the  most  flexible 
motion;  at  the  same  time  it  also  corresponds  to  the  maximum  product  of  the 
required  joint  torques  needed  to  resist  the  forces  at  the  end-eflector.  Assuming 
the  available  end-effector  force  for  an  arm  with  tight  limitation  on  joint  torques 
is  important  for  an  application,  maximum  |J|  is  not  a  desirable  solution  At 
the  position  with  maximum  |Jj,  the  manipulator  also  maximizes  the  absolute 
position  error.  The  criterion  for  the  best  posture  of  an  arm  really  depends  on 
the  task,  and  on  its  motion,  force  or  error  requirements. 

The  \/JJT  has  been  defined  as  the  measure  for  kinematic  manipulability  of  a 
redundant  manipulator  [Yoshikawa,  ’85].  The  same  can  be  used  for  considering 
force  manipulability,  and  all  the  comments  above  can  be  extended  to  a  redundant 
manipulator.  To  show  this,  we  explain  how  the  kinematic  and  force  study  of  a 
redundant  manipulator  can  be  performed  on  an  equivalent  non-redundant  pseudo 
manipulator. 


For  a  redundant  manipulator  we  replace  JnXn  by  /rXn,  where  n  >  r  and  JrXn  is  of 
rank  r.  Since  JTJ  is  symmetric,  we  can  always  get  ar.  orthogonal  transformation 
mat  rix  C,  which  makes  CTJTJC  a  diagonal  matrix  and  transforms  from  a  pseudo 
joint  rate  vector  $  to  0:  0  =  C<I>.  As  JTJ  is  a  semi  positive  definite  matrix 
of  rank  r,  there  will  be  n  —  r  zero  eigenvalues.  We  partition  C  =  [C, ,  C2]  and 
4>  =  [Qf,  <F[]T,  where  Cj  corresponds  to  the  non-zero  eigenvalues  and  C2  to  the 
zero  eigenvalues,  then  we  have  JC2  =  0  since  [J  C2]T  [J  C2\  is  a  null  sub-matrix. 
From  X  =  JO  =  ( JCX  JC2)$  =  (JC:  <?)<£  we  have  A’  =  J'4>i,  where 

j ;  =  Jlc1.  So  xTx  = 

For  the  force  part  we  define  a  pseudo  torque  vector  T  which  satisfies  0rr  =  4>^F, 
then  T  =  CT t  =  [7,,  72]t.  It  also  satisfies 


r  =  ( JC)TF  =  [J,*,  0}TF  =  J" F. 


(8.3) 


So  7!  =  J‘T F  (and  72  =  0).  At  this  step  we  have  built  up  a  statically  equivalent 
pseudo  non-redundant  manipulator,  with  effective  pseudo  joint  rates  $1  and 
effective  pseudo  torques  7^  The  relations  here  are  quite  simple, 


SxiSx2 . . .  6xr  =  \j;\8<t>x6<i>2  . . .  6<f>r, 


(8.4) 
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7i72  •  •  -  7r  =  \  Ji\f1f2  -  •  -  /r-  (8.5) 

Using  |  J*|  as  a  measure  for  kinematic  and  force  manipulability,  means  we  consider 
the  motion  and  force  mechanical  advantage  with  the  effective  joint  rates  and 
effective  torques  as  input.  For  effective  joint  rates,  is  the  minimum  norm  of 

0T0.  For  effective  torques,  7,t7i  =  ttt.  Since  \  JJT\  =  \  JCCT  JT\  =  = 

so  gives  the  measure  for  force  manipulability  as  well. 

Sometimes  we  need  to  consider  the  directional  mechanical  advantages.  The  op¬ 
timal  configuration  of  an  arm  corresponding  to  the  appropriate  manipulability 
then  needs  to  be  based  on  both  the  indices  JCJJ  and  y/tt  m  or  some  other 
partition  of  the  Jacobian  matrix.  For  example,  it  is  beneficial  for  a  2-link  pla¬ 
nar  manipulator  to  be  in  a  nearly  stretched  out  position  if  the  motion  direction 
corresponds  to  the  eigenvector  due  to  the  maximum  eigenvalue  and  the  force 
direction  corresponds  to  the  eigenvector  due  to  the  minimum  eigenvalue  (The 
singularity  direction  where  the  contact  force  is  uncontrollable  should  always  be 
avoided).  The  directional  measure  is  also  useful  in  the  selection  of  optimal  arm 
configurations  based  on  dynamic  manipulability,  because  in  certain  directions  we 
need  to  have  less  inertia  while  in  the  others  we  may  need  to  have  larger  inertias. 


Chapter  6 

AL  LANGUAGE  SPECIFICATIONS 

FOR  CONTACT 


Using  the  task-frame  specifications  discussed  in  the  previous  chapter,  we  now 
describe  extensions  to  the  AL  robot  language  which  facilitates  the  high-level 
programming  of  direct  contact  motions. 

A  robot  language  is  an  interface  between  a  human  operator  and  a  robot;  a 
good  language  can  accommodate  a  wide  range  of  applications.  Generality  and 
simplicity  are  vital  attributes  of  robot  languages.  Language  statements  directing 
the  end-effector  of  a  robot  to  contact  or  roll-slide  on  a  fixed  surface  or  a  workpiece 
require  special  programming  considerations.  Free  motion  of  a  manipulator  is 
much  simpler  to  specify  than  direct  contact  motion.  A  user  of  a  robot  language 
should  be  able  to  specify  a  general  trajectory  for  a  moving  body  to  maintain 
contact  with  a  curved  surface.  In  each  position,  the  task  frames  are  important  for 
mot  ion  or  force  control.  One  problem  for  a  high-level  language  is  how  to  calculate 
such  task  frames.  The  other  problem  is  how  to  specify  the  instantaneous  motion 
requirements  with  respect  to  such  frames. 

We  develop  the  necessary  high  level  statements  by  modifying  the  AL  robot  lan¬ 
guage  to  include  direct  contact  statements.  AL  has  been  under  development  at 
Stanford  University  for  about  fifteen  years.  Its  operation  commands  are  syntac¬ 
tically  structured  as  follows: 
operation  statement 
with  clauses 
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condition  monitor  clauses 

The  operation  statement  specifies  the  moving  object  and  its  destination  and  via 
positions;  with  clauses  specify  the  parameters  of  the  trajectory,  motion  speed, 
stiffness,  etc.;  condition  monitor  clauses  specify  the  action  under  certain  run¬ 
time  conditions.  In  the  following,  we  use  AL  to  denote  the  new  version  of  the  AL 
robot  language  which  now  contains  all  the  statements  discussed  in  this  chapter. 

6.1  Geometry  of  a  moving  object 

As  a  supplement  to  the  frame  data  type  (which  uniquely  specifies  the  spatial 
position  and  orientation  of  a  frame  on  the  moving  body),  an  object  data  type  with 
geometrv  information  has  been  added  to  AL  as  a  control  identity.  Such  geometric 
information  is  necessary  for  determining  task  frames  and  normal  accelerations 
when  the  object  moves  with  direct  contact  between  curved  surfaces  (or  is  going 
to  be  re-positioned  in  a  three-finger-hand). 

AL  can  now  define  an  object  in  a  data  declaration  statement, 
object(shape  (circular-cylinder,  r,  /),  frame) 

shape  (circular-cylinder,  r,  /)  gives  the  radius  and  height  of  the  circular  cylinder, 
and  frame  defines  the  current  position  of  the  object. 

For  an  object  moving  with  point  or  line  contact,  only  the  geometry  of  its  con¬ 
tacting  surface  is  interesting  to  us,  and  in  many  cases  it  can  be  represented  in 
an  analytic  form.  We  can  similarly  define  analytically  simple  surfaces  such  as  a 
sphere,  an  ellipsoid,  a  cylinder  with  rectangular  or  curved  cross  sections,  and  a 
simple  ruled  surface.  Complex  surface  geometry  can  be  specified  by  a  sequence 
of  surface  points,  and  be  approximated  locally  by  a  plane  (three  points)  or  a 
second  order  algebraic  surface  (nine  points). 

A  compound  object  composed  of  simple  blocks  can  be  defined  by  the  affixment 
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6.2  Cartesian  trajectory  of  a  moving  object 


An  object’s  trajectory  can  be  characterized  by  an  interpolation  trajectory,  a 
function  trajectory,  a  run-time  trajectory,  etc..  The  interpolation  trajectory  is 
the  most  important  during  planning.  The  position  trajectory  (of  a  reference 
point)  and  rotation  trajectory  (of  the  object  about  the  reference  point)  will  be 
discussed  separately. 

Position  trajectory  interpolating  through  via-poinis 

The  position  trajectory  for  contact  must  satisfy  surface  constraint.  However, 
determining  a  contact  trajectory  from  a  surface’s  equation  is  computationally 
expensive,  we  partition  the  position  trajectory  under  contact  into  two  vectors 
X  =  XF  +  SX,  where  XF  an  interpolation  trajectory  as  if  the  reference  point 
were  moving  in  free  space  and  6X  an  error-correction  trajectory. 

In  AL  we  have  included  three  types  of  trajectories  for  XF.  The  first  is  com¬ 
posed  of  a  sequence  of  line  segments  with  sharp  corners,  where  a  manipulator 
has  to  stop  momentarily  before  switching  direction  (except  when  two  consecutive 
segments  are  aligned).  The  second  is  composed  of  line  segments  with  rounded 
junctions,  whose  radii  can  be  determined  from  centripetal  acceleration  or  geo¬ 
metric  constraints.  And  the  third  is  a  smooth  planar  or  spatial  curve  required 
for  a  complex  geometric  environment  or  operation.  Some  spline,  say  a  natural 
spline  (with  approximate  minimum  total  curvature),  will  be  used.  A  user  can 
specify  a  trajectory  by  selecting 


with  position  in  linear  path 
with  position  in  curved  path 

The  default  is  set  as  the  linear  trajectory  with  rounded  junctions. 

If  some  velocity  is  also  specified  at  a  via  point,  the  trajectory  segment  is  usually 
not  a  line,  but  a  planar  or  spatial  curve 
where  velocity  =  vector 


When  position  control  is  performed  on  the  tangential  plane  at  contact,  and  force 
control  is  performed  on  the  contact  normal,  SX  is  automatically  corrected  by 
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planned  (^V) 


Figure  6.1  Position-error  correction  trajectory 

force  control.  We  can  calculate  6X  explicitly  in  order  to  obtain  the  normal 
acceleration  (if  there  are  no  sensors  available  from  which  to  calculate  the  normal 
acceleration  as  described  in  the  last  chapter).  6X  will  be  a  null  vector  when  the 
object  is  at  either  node  of  a  segment  (assuming  the  node  points  are  accurate).  For 
intermediate  position  8X  can  be  the  projection,  onto  the  instantaneous  contact 
normal,  of  a  vector  between  the  planned  and  actual  reference  points  (under  the 
assumption  that  the  object  maintains  its  contact)  (Fig.  6.1(a)  (b)). 

Rotation  trajectory  interpolating  through  via-orientations 

When  an  object  moves  under  point  contact,  the  rotation  trajectory  can  be  re¬ 
garded  as  though  the  motion  is  in  free  space.  When  an  object  moves  under 
line  contact,  we  can  partition  the  rotation  trajectory  into  a  free  space  trajectory 
and  an  error-correction  trajectory,  in  a  manner  similar  to  that  used  for  position 
trajectories  under  point  contact. 

In  free  space,  the  interpolation  of  rotation  trajectories  can  be  calculated  using  a 
quaternion  representation,  for  the  orientation  of  a  reference  line  (in  an  object) 
and  the  object’s  rotation  about  the  line. 

Commonly,  an  orientation  A  with  respect  to  a  reference  orientation  O  can  be 
represented  by  a  quaternion  Qao-  a  rotation  from  orientation  O  to  that  of  A. 
Similarly,  for  an  orientation  B  we  can  have  a  quaternion  representation  Qbo  By 
quaternion  calculus  we  have  QBo  =  QbaQao,  where  QBA  is  a  quaternion  which 
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Figure  6.2  Rotation  with  a  line  trajectory  specified 
represents  a  rotation  from  A  to  B  [Bottema  and  Roth,  ’79]. 

Unfortunately,  the  interpolation  of  quaternions  does  not  yield  a  quaternion  which 
satisfies  the  rotation  requirements.  For  many  rotations,  people  are  interested  in 
the  orientation  trajectory  of  a  reference  line  and  the  object’s  rotation  about  the 
line.  Most  objects  have  a  meaningful  axis  (the  spinning  axis  of  a  screw  driver, 
the  symmetric  axis  of  a  circular  peg,  the  nozzle  axis  of  a  spray  gun,  etc.),  which 
can  be  considered  as  a  reference  line.  In  some  cases  this  line  is  our  only  concern 
and  we  may  pay  no  attention  to  the  object  rotation  about  the  line  (this  is  the 
case  for  symmetric  motions  such  as  inserting  a  circular  peg). 

A  reference  line  rotation  trajectory  commonly  can  take  two  patterns.  One  pat¬ 
tern,  as  shown  in  Fig.  6.3(a),  occurs  when  the  spherical  image  curve  of  a  reference 
line  stays  in  a  plane  and  there  is  object  rotation  about  the  line  as  well.  The  ac¬ 
tual  orientation  trajectory  of  the  object  is  the  superposition  of  a  simple  rotation 
of  the  reference  line  and  the  object  rotation  about  the  line.  We  assume  that  /, 
and  l2  are  the  initial  and  goal  positions  for  a  reference  line,  Cl  is  a  vector  per¬ 
pendicular  to  both  of  them,  and  a  line  R  fixed  in  the  moving  body  initially  takes 
the  position  of  R j  which  is  coincident  to  Cl,  and  R2  in  the  goal  position.  Let  92 
be  a  rotation  angle  about  the  reference  line  measured  between  R2  and  Cl.  If  it 
is  not  specified  otherwise,  the  reference  line  will  rotate  with  a  constant  angular 
velocity.  In  some  intermediate  position,  /?m,  the  line  R  moves  to  an  intermediate 
position  Rm)  and  we  can  calculate  the  angle  9m  between  Rm  and  Cl  such  that 
9m  =  02Pm/ fi2,  a  proportional  rotation  about  the  reference  line. 
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Figure  6.3  Types  of  reference-line  trajectories 

We  adopt  the  conventions  that  the  rotation  angle  of  the  reference  line  is  /?2  < 
180  degrees,  and  that  the  positive  rotation  direction  around  the  reference  line 
corresponds  to  a  right-hand  screw.  If  there  is  no  rotation  around  the  reference 
line,  the  trajectory  is  reduced  to  a  simple  rotation  of  the  reference  line. 

The  same  concept  can  be  extended  for  several  intermediate  or  via  orientations, 
and  the  spherical  image  of  the  reference  line  will  consist  of  several  planar  seg¬ 
ments. 

The  second  trajectory  pattern  follows  if  we  consider  that  the  reference  line  traces 
a  smooth  cone  in  the  spherical  image  space  (a  plane  is  a  special  case  of  a  cone).  A 
unit  vector  1  (parallel  to  the  reference  line)  from  the  origin  is  uniquely  determined 
by  two  angles  or,  /?,  where  a  is  the  angle  rotating  about  a  unit  vector  k  along 
the  z  axis  (Fig.  6.3(b)).  We  can  interpolate  a  natural  spline  representation  of 
a  and  (3  so  that  a  and  /?  are  continuous  to  second  order  at  the  end  points  of 
each  segment.  The  same  continuity  will  be  present  in  the  corresponding  spherical 
image  curve.  If  we  add  one  rotation  angle  9  about  the  reference  line,  then  the 
angular  velocity  of  the  body  is  U  =  ak  +  01  +  /?k  x  l/|k  x  1|,  and  its  component 
perpendicular  to  1  is  XT  =  ST  —  Qll  =  d(k  —  (k  ■  1)1)  +  /?(k  x  l)/|k  x  1|,  which 
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must  be  parallel  to  the  normal  of  the  spherical  image  cone.  As  an  alternative  to 
the  selection  of  a  and  /?  in  determining  1  and  fi,  we  can  project  the  end-points  of 
the  controlling  vectors  of  the  spherical  image  (starting  direction,  via  directions, 
and  goal  direction)  onto  a  plane  (for  example,  a  plane  tangential  to  the  image 
sphere),  interpolate  a  curve  through  those  projected  points  on  the  plane,  and 
then  map  each  point  of  the  planar  curve  back  to  the  spherical  image.  For  general 
motion  of  of  a  reference  line,  Cl  varies.  However,  we  can  still  determine  6  angle. 
Assume  that  a  certain  line  R  (fixed  in  the  moving  body  and  perpendicular  to 
the  reference  line)  initially  takes  position  Rx ,  which  is  coincident  with  the  initial 
Cl,  and  then  takes  position  R2  at  the  goal  orientation,  also  assume  that  02  is  an 
angle  measured  between  the  R7  and  the  final  Cl,  then  the  intermediate  rotation 
0  measured  between  R  and  O,  with  range  0  to  02,  can  be  interpolated. 

For  such  rotational  trajectories,  besides  via  and  goal  orientations,  the  user  is 
additionally  required  to  specify  a  vector  parallel  to  the  reference  line  at  the 
initial  position.  From  such  information  the  system  can  calculate  the  via  and  the 
goal  directions  for  the  reference  line  and  the  required  rotation  angle  about  the 
line.  The  calculation  frame,  consisting  of  three  mutually  perpendicular  vectors 
Ri ,  li ,  Ri  x  /,,  has  a  fixed  orientation  with  respect  to  an  object  frame  (they  may 
be  coincident).  If  we  have  determined  the  trajectory  of  the  calculation  frame,  at 
the  same  time  we  know  the  trajectory  of  the  object  frame.  Likewise,  from  the 
orientation  of  the  object  frame  we  can  determine  the  calculation  frame. 

In  AL  one  can  now  specify  an  orientation  trajectory  by  saying, 
with  reference-vector  in  planar  path 
with  reference-vector  in  conic  path 

For  the  rotation  trajectory  error  correction,  if  the  object  is  under  control  of  mo¬ 
ment  or  force,  the  rotation  error  will  be  automatically  corrected.  If  there  is  no 
accurate  force  sensor  which  can  determine  the  angular  acceleration  along  the 
force-controlled  direction,  we  can  explicitly  calculate  the  trajectory.  The  error- 
correction  trajectory  has  null  values  at  the  beginning  and  end  of  a  trajectory 
segment;  elsewhere  it  depends  on  an  error  angle  measured  between  the  projec¬ 
tions  of  the  desired  and  actual  positions  of  a  reference  line  on  a  plane  which 
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Figure  6.4  Rotation-error  correction  trajectory 

passes  through  the  contact  line  and  the  contact  normal  (Fig.  6.4).  Here  we 
assume  that  the  object  maintains  its  line  contact. 

Function  trajectories 

AL  provides  a  general  helicoidal  motion,  for  which  the  circular  motion  is  a  special 
case.  This  can  be  useful  since  in  assembly  most  workpieces  have  either  planar  or 
cylindrical  surfaces. 

move  frame  by  s  about  rot^vecior  at  pos.veclor 
with  pitch  =  s 

where  the  rot.vector  and  pos.vector  uniquely  specify  the  rotation  screw  axis,  and 
the  pitch  is  the  ratio  of  the  translation  along  the  axis  over  the  rotation  angle. 
Some  other  function  trajectories  can  be  obtained  by  calculating  one  of  many  AL 
pre-defined  functions  within  a  loop  structure. 

Motion  monitored  for  run-time  conditions 

Sometimes  a  motion  is  monitored  for  run-time  conditions  on  force,  velocity,  posi¬ 
tion,  time,  etc.:  a  force  condition  is  sensitive  to  contact  and  is  useful  in  locating 
an  obstacle,  Fig.  6.5(a);  a  velocity  component  (along  the  sliding  surface  nor¬ 
mal)  determines  when  a  tilted  peg  slides  down  into  a  hole,  Fig.  6.5(b);  position 
boundary  information  may  provide  the  limit  to  stop  a  motion.  AL  now  lets  the 
user  specify 

on  force  rel  s  along  vector  do  action  | 
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Figure  6.5  Condition-monitored  motions 

on  velocity  rel  s  along  vector  do  action 

on  position  rel  s  along  vector  do  action 

on  time  rel  s  do  action 
*- _ _ — — - 4 

where  rel  can  be  >,  <,  >,  <. 

Once  condition  monitors  are  specified,  it  is  then  possible  to  specify  a  directional 
motion  using  the  new  move  statements 
move  frame  along  vector 

move  frame  about  rotation-vector  at  position-vector 

Similarly,  an  object-centering  strategy  (which  is  sometimes  necessary  to  satisfy 
assembly  clearance  requirements  or  to  reduce  friction)  is  also  possible.  It  is 
performed  by  having  the  manipulator  make  touches  at  two  extreme  ends  first, 
then  move  to  the  center  position.  This  operation  can  be  performed  either  along 
one  direction,  or  two  symmetrical  directions  about  a  specified  axis, 
center  object  along  (about)  vector 

It  is  also  possible  to  let  a  local  trajectory,  surface  contacting  or  non-contacting, 
be  determined  from  sensory  information.  We  can  build  a  reflexive  strategy  into 
the  control  system;  for  example,  the  local  moving  direction  can  be  made  perpen¬ 
dicular  to  the  surface  normal. 


The  condition  monitor  can  be  used  for  spiral  searching  as  well.  Sometimes  the 
exact  desired  position  is  not  known  in  advance,  but  it  can  be  located  by  match- 
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ing  several  run-time  conditions,  such  as  force  or  velocity  conditions.  When  no 
searching  direction  is  superior  to  another,  the  nominal  approach  is  to  move  in  a 
spiral. 

slide  frame  around  vector 
with  step  =  s 

6.3  Calculation  of  contact-task  frames 

Since  an  object  trajectory  is  partitioned  into  a  position  and  a  rotation  trajectory, 
there  is  a  corresponding  positional  task  frame  and  a  rotational  task  frame. 

AL  allows  the  introduction  of  a  moving  object  with  predefined  geometry, 
slide  [move]  object  [ more  specifications ] 

From  such  specifications  we  know  the  moving  body’s  geometry  and  trajectory. 
We  assume  there  is  a  force  sensor  mounted  on  a  robot  arm,  and  consider  the 
kinematics  and  force  sensing  aspects  for  determining  the  contact  task  frames, 
whose  origins  are  usually  associated  with  the  contact  points. 

Positional  task  frame 

As  an  object  moves  with  surface  contact  between  two  planes,  a  positional  task 
frame  can  be  determined  from  the  trajectory’s  geometry.  The  frame’s  origin  is 
the  reference  point  and  its  axes  are  mutually  perpendicular  unit  vectors  i,j,k, 
respectively, 

v  .  a  -  (a  i)i  .  . 

1  =  j— ,,J  =  ±  1 - 7 - rrrr,  k  =  1  X  J, 

|vj  |a  —  (a  -  i)i| 

where  v  and  a  are  the  velocity  and  acceleration  of  the  reference  point,  and  k 
is  the  trajectory  plane’s  normal.  We  assign  the  x  axis  along  the  trajectory’s 
tangent,  and  z  axis  along  the  trajectory  normal. 

When  a  reference  point  moves  in  a  straight  line,  the  principal  normal  and  bi- 
normal  are  undefined.  For  an  axially  symmetrical  motion  (for  example,  inserting 
a  circular  peg),  the  explicit  determination  of  one  axis  may  not  be  necessary; 
in  many  other  cases  (for  example,  sliding  an  object  on  a  plane)  we  may  need 
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to  specify  one  axis,  corresponding  to  the  plane  normal,  for  the  positional  task 
frame. 

with  pos_frame  y(z)  =  vector 

For  some  cases  of  planar  motion  with  point  contact  between  two  curves,  the 
positional  task  frame  can  be  determined  from  the  trajectory  alone  with  the  ap¬ 
propriate  choice  of  a  reference  point.  For  a  planar  motion  with  point  contact, 
the  trajectory  of  a  generic  point  on  a  moving  curve  does  not  necessarily  trace  the 
fixed  curve;  however,  if  the  contact  point  is  invariant  with  respect  to  the  moving 
curve,  its  motion  trajectory  should  foiiow  the  fixed  curve.  At  any  instant,  all 
points  on  a  line  moving  to  coincide  with  the  curve  normals  (except  points  coin¬ 
ciding  with  the  curvature  center  point  of  the  fixed  curve)  have  the  same  tangent 
and  normal  directions  as  those  of  the  fixed  curve.  If  there  is  a  point  fixed  in 
the  object  such  that  it  always  lies  on  the  contact  normal,  then  the  tangent  and 
normal  of  its  trajectory  are  parallel  to  those  of  the  fixed  curve  at  the  contact 
point.  One  common  example  is  when  a  contact  point  is  fixed  with  respect  to  a 
moving  curve.  When  a  moving  curve  is  reduced  to  a  circle,  although  the  contact 
point  varies  with  respect  to  the  circle,  the  center  point  is  fixed  in  the  moving 
circle,  and  can  be  chosen  as  a  reference  point. 

Other  than  in  the  special  cases  above,  we  usually  require  additional  knowledge 
of  a  moving  body’s  geometry  or  motion  kinematics  in  order  to  determine  the 
positional  task  frame  for  a  general  planar  motion  with  point  contact  between 
two  curves.  For  pure  rolling  the  contact  point  is  at  the  intersection  of  the  normal 
of  the  reference  point’s  trajectory  and  the  moving  curve.  For  pure  translation, 
the  contact  point  is  at  the  intersection  of  the  moving  curve  and  a  tangent  line 
parallel  to  the  velocity.  For  general  motion,  we  need  to  find  a  point  on  the  moving 
curve  with  null  normal  velocity  (given  the  contact  point  at  the  last  instant,  the 
current  point  will  be  in  its  vicinity).  After  the  contact  point  has  been  located, 
the  contact  normal  can  be  determined  from  the  moving  curve. 

One  exception  for  pure  translation  is  when  the  moving  curve  reduces  to  a  line. 
In  this  case,  the  exact  contact  point  is  not  obvious  from  only  the  moving  curve 
information,  but  the  contact  normal  direction  is  certainly  known. 
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Figure  6.6  Spatial  motion  with  point  contact 

For  the  spatial  motion  of  a  rigid  object  with  point  contact  '  nd  no  frictional 
torques  at  the  contact  point),  the  velocity  field  provides  only  a  partial  guide 
in  determining  the  contact  point.  For  pure  rolling  (Fig.  6.6(a)),  we  can  pick 
two  arbitrary  points  in  the  moving  body,  and  find  the  intersection  line  of  the 
normal  planes  of  their  point  trajectories,  this  line  intersects  the  moving  surface 
at  the  contact  point.  However,  for  pure  translation  (Fig.  6.6(b)),  the  normal 
planes  are  all  parallel  and  we  cannot  use  the  velocity  to  determine  the  contact 
point.  Obviously,  for  a  general  motion  the  control  frame  can  not  be  completely 
determined  just  from  the  motion  trajectory  and  moving  surface  geometry. 

The  alternative,  which  is  actually  simple  and  fast,  is  to  determine  the  contact 
point  from  force  sensors.  Under  the  constraint  of  no  frictional  torque  at  the 
contact  point,  we  can  generally  find  a  force  wrench  axis  which  intersects  the 
moving  surface  at  the  contact  point,  regardless  of  whether  the  moving  body 
undergoes  a  pure  rolling,  a  pure  sliding  or  a  general  motion,  and  regardless  of 
whether  there  are  frictional  forces  at  the  contact  or  not. 

Rotational  task  frame 

When  the  rotation  trajectory  is  obtained  by  quaternion  interpolation,  we  can 
have  one  axis  of  the  rotational  task  frame  parallel  to  either  the  angular  velocity, 
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or  a  finite  displacement  screw  axis,  or  one  axis  of  the  world  frame.  However  we 
prefer  to  have  the  rotation  trajectory  associated  with  a  reference  line,  in  which 
case  the  spherical  image  of  the  reference  line  yields  a  cone.  We  take  the  x  axis  of 
the  rotational  task  frame  parallel  to  the  reference  line,  and  the  z  axis  parallel  to 
the  contact  normal  of  the  cone  (ft  as  mentioned  in  the  last  section).  This  task 
frame  is  justifiable  since  we  are  interested  in  the  motion  of  a  reference  line  and 
the  object  rotation  about  the  line. 

For  a  simple  rotation,  although  a  reference  line  is  usually  not  explicitly  specified, 
the  rotation  axis  quite  often  has  a  clear  operational  meaning  and  we  can  regard  it 
as  a  reference  line;  in  addition,  we  need  to  explicitly  specify  one  axis  to  complete 
the  definition  of  the  task  frame.  It  seems  convenient  to  specify  the  axis  with 
respect  to  an  object  frame  or  a  frame  affixed  to  it  (a  hand  frame  if  the  object 
is  grasped  by  a  simple  gripper).  The  following  statements  will  now  accomplish 
this. 

with  rot_frame  y(z)  =  vector 

with  rot _frame  y(z)  =  vector  wrl  world. 

When  an  object  is  under  line  contact,  the  x  axis  is  the  contact  line,  and  the  z 
axis  is  parallel  to  the  contact  normal.  The  positional  task  frame  and  rotational 
task  frame  have  one  axis  (contact  normal)  in  common. 

The  kinematic  condition  for  line  contact  on  a  ruled  surface  is  that  there  is  no 
angular  velocity  component  in  the  direction  which  is  perpendicular  to  both  the 
contact  line  and  contact  normal.  From  the  force  condition,  the  force  wrench  axis 
always  passes  through  the  contact  line  if  the  friction  torque  about  the  contact 
line  is  negligible.  If  there  is  sliding  at  the  contact  line,  the  force  wrench  becomes 
a  pure  force. 

6.4  Motion  constraints  with  respect  to  task  frames 

In  order  to  have  satisfactory  relative  motion  of  the  end-effector  under  contact, 
the  error-tolerances,  stiffnesses,  forces  and  directional  wobble  are  important  pa¬ 
rameters  which  need  to  be  specified  with  respect  to  the  task  frames. 
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Error  tolerance  is  necessary  for  obstacle  avoidance  as  well  as  in  operations  re¬ 
quiring  precision.  By  the  appropriate  choice  of  error  tolerances,  we  can  make  an 
operation  more  efficient  and  economical.  Especially  when  a  redundant  manipu¬ 
lator  is  used,  bigger  tolerances  allow  for  turning  off  fine  motion,  and  driving  only 
the  coarse  motion. 


control  gain 
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Figure  6.7  A  corresponding  control  gain  for  an  error  tolerance 


To  the  run-time  control  system,  an  error  tolerance  is  seen  as  a  variable  control 
gain  or  stiffness.  Take  the  x  direction  as  an  example:  we  can  pick  kx  =  1/ 
|(6x  +  a)(6x  —  a)|,  where  a  is  the  error  tolerance  in  the  x  direction  and  8x  a 
measured  error  (Fig.  6.7). 

In  AL  one  can  now  specify  the  error  tolerance  by  simply  saying 
with  tolerance  =  (3,5,3) 
with  tolerance  =  (3,3,5, s,s, 3) 

Instead  of  error  tolerance,  we  sometimes  specify  constant  stiffness  coefficients, 
and  in  the  contact  direction  AL  interprets  the  stiffness  as  directly  associated 
with  the  contact  surface.  Normally  the  stiffness  coefficients  are  regarded  as  the 
position  gains  for  a  robot,  or  the  stiffness  between  the  robot  and  an  object.  In 
certain  situations,  e.g.  polishing  or  grinding,  we  require  the  force  applied  by  the 
tool  to  a  workpiece  to  be  proportional  to  the  position  error,  in  these  cases  the 
tool’s  inertia  and  elasticity  should  be  taken  into  account. 

When  the  contact  surface  is  elastic  with  stiffness  coefficient  k,,  the  effective 
stiffness  coefficient  for  the  direct  contact  will  be  equal  to  or  less  than  k,.  If  k,  is 
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zero,  as  in  free  space,  no  force  is  applied  between  the  object  and  the  environment. 
AL  can  do  automatic  mode  selection:  when  noting  a  hard  contact  it  uses  foice 
control,  otherwise  it  uses  pure  position  control. 

For  most  cases,  a  force  trajectory  is  not  independent  of  the  motion  trajectory. 
For  a  force  guarded  motion,  the  desired  force  is  usually  a  constant  along  one  or 
two  axes  of  the  positional  task  frame.  Similarly,  with  respect  to  the  rotational 
task  frame,  moments  of  force  are  normally  specified  on  one  or  two  axes. 


Figure  6.8  Examples  of  directional  wobble 

Directional  wobble  was  added  to  AL  in  order  to  expand  the  types  of  built-in 
motion  trajectories  and  for  reducing  friction.  In  operations  such  as  erasing  a 
line  of  pencil  writing,  or  using  a  piece  of  cloth  to  clean  a  long  narrow  area:  one 
traces  a  zigzag  trajectory,  this  is  a  wobble  motion  perpendicular  to  the  main 
direction  of  motion.  Accurate  straight  line  motion  is  not  desirable  because  dirt 
will  be  accumulated  along  the  moving  direction.  Other  examples  are  the  use  of 
rotational  wobble  for  a  spray  gun’s  motion  in  order  to  have  an  up  and  down 
wobble  rotation  to  cover  more  area,  Fig.  6.8(a),  and  the  use  of  positional  wobble 
to  break  friction  along  a  motion  trajectory.  (It  is  also  used  in  welding  to  get  a 
good  bead.) 

The  directional  wobble  should  be  specified  with  respect  to  the  task  frame.  The 
translational  wobble  motion  is  desired  to  be  perpendicular  to,  or  axially  sym¬ 
metrical  about  the  trajectory.  It  is  most  appropriately  specified  with  respect  to 
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the  positional  task  frame.  A  similar  relation  holds  between  the  rotational  wobble 
motion  and  the  rotational  task  frame.  The  wobble  rotation  can  be  specified  with 
respect  to  one  axis  of  the  rotational  task  frame.  We  have  implemented  in  the  3- 
and  6-axes  statements: 
with  wobble  =  ( s,s,s ) 
with  wobble  =  (s,3,3,3,3,s) 


Figure  6.9  A  peg  rotation 

For  the  application  of  error  tolerances,  stiffnesses,  forces  and  wobble  constraints, 
in  certain  situations  the  positional  task  frame  and  rotational  task  frame  are 
coincident.  For  example,  in  Fig.  6.9,  the  exact  contacting  point  will  be  hard 
to  predict.  Since  we  are  interested  in  having  constant  contact  force  along  the 
contacting  surface  normal  regardless  of  contact  point,  the  positional  task  frame 
becomes  exactly  the  same  as  the  rotational  task  frame.  Another  example  occurs 
when  a  peg  is  to  be  inserted  into  a  cylindrical  hole,  since  no  orientation  trajectory 
is  defined.  If  we  have  the  peg  axis  parallel  to  that  of  the  hole,  we  may  need  to 
apply  a  wobble  rotation  about  the  axis  in  order  to  reduce  friction  (Fig.  6.8(b)). 
The  rotational  task  frame  is  equivalent  to  the  positional  task  frame  in  this  case. 

Another  common  example  of  a  rotational  task  frame  being  coincident  to  a  posi¬ 
tional  task  frame  is  when  one  planar  surface  is  sliding  on  another.  In  this  case 
there  will  be  some  orientation  discrepancy  between  the  two  surfaces  due  to  tra¬ 
jectory  error.  To  maintain  the  planar  contact,  we  need  to  specify  either  null 
rotational  stiffness  coefficients  or  null  moments  on  the  tangential  surface;  the 
tangential  surfaces  are  are  spanned  by  the  two  axes  of  the  positional  task  frame. 
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In  AL  we  can  now  characterize  these  situations  by  saying, 
with  path-frame  y  (z)=  vector 


Chapter  7 


IMPACT  IMPULSE  AND 
LINK-MASS  DISTRIBUTION 


All  the  previous  chapters  deal  with  one  object  already  in  direct  contact  another. 
In  this  chapter  we  consider  the  instant  when  two  objects  are  making  contact.  If 
a  high  speed  motion  is  underway,  or  a  large  mass  is  being  moved,  a  fairly  strong 
collision  may  occur  at  contact.  At  the  instant  of  collision,  the  manipulator’s 
control  system  can  do  little  to  mitigate  the  impact’s  impulse.  In  this  chapter  we 
analyze  the  relationships  between  the  impact  impulse  and  the  mass  distribution 
of  a  revolute-jointed  planar  manipulator.  This  provides  a  guide  to  the  proper 
design  and  motion  planning  for  parallel  axes  revolute-joint  manipulators  working 
under  impact  conditions. 

This  chapter  starts  with  a  discussion  of  what  we  call  the  link-space  representation, 
then  analyzes  the  factors  associated  with  the  impact  impulse  at  the  point  of 
contact.  These  include  the  optimum  pivot  location  for  a  general  link,  the  mass 
distribution  among  different  links,  the  influence  of  the  last  link,  and  the  change 
of  angular  velocity  and  reaction  impulse  at  each  joint. 

Fig.  7.1  shows  a  revolute-joint  planar  manipulator  with  n  moving  links.  For  the 
ith  link,  mt,  I,  are  respectively  the  link  mass  and  the  moment  of  inertia  about 
its  joint  with  the  i  —  1  link,  /,  is  the  distance  between  its  two  joints,  /*  is  the 
distance  from  its  joint  with  the  i  —  I  link  to  the  link-mass  center,  and  /?,  is  the 
angle  between  the  lines  along  which  we  measure  /,  and  /*.  We  also  assume  each 
joint  is  frictionless,  and  there  is  one  impact  contact  point  with  the  environment, 


P 

i 


In  this  chapter  we  use  a  link-space  representation.  The  link-space  coordinates 
are  the  rotation  angles  of  the  links  with  respect  to  the  same  fixed  line,  and 
the  torques  on  links  relative  to  the  base  system.  The  Jacobian  matrix,  which 
relates  the  velocity  of  the  contact  point  to  the  joint  velocity  rates,  and  the  inertia 
matrix  will  take  simpler  forms  in  link-space  than  those  in  joint-space  coordinates. 
Furthermore,  in  link-space  coordinates,  the  link  torques  are  related  to  the  contact 
force  by  the  transpose  of  this  same  simpler  Jacobian  matrix. 


m 


I 


To  illustrate  the  link-space  simplification,  we  take  a  3-link  chain  as  an  example.  If 
we  follow  the  usual  joint-space  convention  and  use  the  relative  rotations  between 
neighboring  links,  we  have  0*  =  [0lt  02,  03]T.  The  velocity,  X,  at  the  contact 
point  satisfies  X  =  J*0“,  where 


-Ci 


COS  0]  +  /2  COS012  +  la  COS  0,3  /2  COS012  -F  ls  cos  013 

sin0,  +  l2  sin^i2  -F  l3  sin0]3  /2  sin  012  4-  /3  sin0,3 


/3  cos0 
L  sin  6 


(i.i) 
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the  inertia  matrix  in  joint  space  is 

(I,  +  m73l]  +  m2/*2  +  m3/12  +  m3/*s  m2/*2  +  m3/12  +  m3/*s  m3/;s  \ 

m2/*2  +  m3/12  +  m3/*s  /2  +  m3/*  +  in3l;3  m3l;a  j  . 

m3/iS  msf23  A  / 


m2/12  +  tti3Ix  2  +  m3/,  j 

m3/;3  \ 

/2  +  m3/2  +  m3/23 

m3/2*s  . 

m3i;s 

A  / 

(1.2) 

=  m2  +  m3,  /, 2  =  /,  /2cos<?2,  /* 2  = 

/3  COs(02  +  f?3  +  /f3),  /23  — 

/2/3  COS03, 

and  /23  =  l2l;cos(03  +  03). 

Noticing  that  there  are  many  overlaps  in  expressions  (1)  and  (2),  we  instead  use 
the  links’  absolute  angular  velocity  vector,  0,  as  a  base;  0  =  \9X ,  9X  +  97,  9X  + 
97  +  03]T.  We  let  the  velocity  at  the  contact  point  satisfy  X  =  JO.  Then,  the 
Jacobian  matrix,  J ,  becomes 


(lxcos0x  /2  cos  9 12  l3cos0l3\ 
/,sin0,  /2sin012  l3s\n9x3  J  ' 


and  the  corresponding  inertia  matrix,  M,  becomes 

(h  +  rn73l\  m2/*2  +  m3/12  m3/*3  \ 

m2/*2  +  m3/i2  /2  +  m3/2  m3 l73  I.  (1.4) 

m3i;3  m3i;3  r3  ) 

The  expressions  (3)  and  (4)  are  simpler  and  hence  more  efficient  for  computation 
than  (1)  and  (2). 

The  same  concept  can  be  extended  to  an  n-link  chain.  We  define  0  =  [0) ,  012,  •  •  •, 
9 |„]T.  9 1 ,  is  the  orientation  angle,  of  the  ith  link,  relative  to  the  base;  Qu  = 
9X  +  97  +  ■  ■  ■  +  9i.  Below  we  use  the  notat  ions  =  l,l:  cos (t?1+1  +  01+2  +  . . .  +  9j), 
l’j  =  /,/*cos(0,+I  +  9l+ 2  +  ...  +0y  +  /?_,),  and  mtJ  =  m,  +  m1+,  +  . . .  +  mr  The 
Jacobian  matrix  now  is: 

r  _  ( JT  \  _  ( licos0i  /2cos012  •••  lncos0in\  .  -v 

\J„  )  \  /i  sin  l7  sin012  ...  Insm9ln  J  ' 

The  corresponding  inertia  matrix  is: 

/  /i+m2n/?  m2/*2  +  m3n/,2  •••  rnj’ln  \ 


M(n  x  n)  = 


m2/*2  +  m3n/I2  +  m3n/2 
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In  the  case  of  a  slender-rod  linkage,  the  mass  center  of  each  link  is  at  its  geometric 
center.  Hence,  /*  =  1/2  and  /?<  =  0-  The  moment  of  inertia,  of  the  ith  link  about 
either  of  its  joint  axes,  is  I,  =  1/3 m,/*,  m,  is  the  mass  and  /,  is  the  length  of  the 
ith  link.  (6)  becomes 


M(n  x  n)  = 


(|m2  4-  m3n)/12 
( +  m3n)/12  (jm2  +  mJn)lj 


hmJi, 


2  n— 1  )r 


|mn/ln 

“  mn/(  n  —  1  )  n 


In  link  space,  a  link  torque  vector,  T,  is  related  to  the  contact  force  at  the 
contact  point,  F,  by  the  transpose  of  the  Jacobian  matrix,  JT.  We  assume  the 
joint  torque  vector,  r,  has  components  r,;  i  ~  1, 2,  •  •  •  n.  The  link  torque  vector, 
r  =  [71 ,  72,  •••,  7n]r,  should  satisfy 


QTr  =  0*Tr  =  Tx6y  +  T202  +  •  •  •  +  rjn. 


This  is  equivalent  to 


7i  +  72  +  7a  +  •  •  •  +  7n 
72  +  7s  +  •  ■  •  +  7n 


T  =  [(r,  -  r2),  (r2  -  rs),  •••,  rn]T .  (1.9) 

On  link  i,  r,  is  the  active  torque  applied  by  joint  t,  and  r1+1  is  the  reaction  torque 
applied  from  joint  i  +  1,  so  7,  =  7\  —  r1+1  is  the  resultant  applied  torque.  Since 
©*r  in  (8)  is  equal  to  XT F,  and  since  X  =  JO,  the  contact  force  at  the  contact 
point,  F,  is  mapped  to  T  by  JT: 


r  =  JTF. 


(1.10) 


The  idea  of  link  space  can  also  be  applied  to  spatial  linkages.  For  either  planar 
or  spatial  linkages  with  several  series  and  several  in-parallel  connected  links,  we 
can  combine  a  partial  link  space  and  a  partial  joint  space. 
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7.2  Impact  impulse  at  point  of  contact 

Based  on  link-space  representations,  we  now  obtain  the  impact  impulse  at  the 
point  of  contact,  as  a  function  of  approach  velocity  and  linkage  configuration.  The 
derived  expressions  consider  general  situations  and  one  particular  case:  perfectly 
elastic  collision  and  no  surface  friction. 

We  assume  that  all  conventional  external  forces,  such  as  gravitational  forces  and 
applied  torques  are  approximately  constant  during  the  impact  interval  (which 
is  much  shorter  than  the  usual  controller’s  sampling  period),  and  that  their  re¬ 
sultants  are  negligible  compared  to  the  impact’s  impulse.  Hence,  from  (1.10), 
the  environment  acts  on  the  manipulator  with  a  generalized  impulse  vector 
1  =  JT  J  Fdt.  Since  0  is  a  generalized  coordinate  vector,  the  manipulator’s 
generalized  momentum  vector  is  P  =  dK/dO  =  MQ.  From  the  principle  that 
the  generalized  impulse  applied  to  a  system  equals  its  change  in  generalized  mo¬ 
mentum  [Kane  and  Levinson,  ’8 5],  P(t2 )  —  P(tt)  =  1: 

0  —  0°  =  M~lJTS.  (2.1) 

S  is  the  impact  impulse  vector  which  is  transmitted  to  the  manipulator  at  the 
contact  point;  S  =  J  Fdt  =  [ST,  5/v]r.  The  subscripts  T  and  N  denote  the 
tangential  and  normal  components,  respectively.  We  take  N  as  always  pointing 
toward  manipulator’s  contact  point  along  the  common  contact  surface  normal 
and  T  such  that  according  to  the  right-hand  rule,  T  x  N  yields  a  vector  pointing 
out  of  the  paper.  0°  and  0  are  the  links’  angular  velocity  vectors  before  and 
after  collision,  respectively;  0°  =  [5°,  0°2,  ...,  0fn]r.  If  by  joint  angle  sensing 
we  can  determine  the  velocities  in  both  states,  then  the  impact  impulse  5  can 
be  calculated  from 

5  =  [J  JT]~'  J  M  (Q  —  0°).  (2.2) 

By  virtue  of  the  constraints  on  the  normal  and  tangential  velocity  components 
after  collision,  5  can  be  represented  as  a  function  of  0°.  Using  the  coefficient 
of  restitution  e  [Kane  and  Levinson,  ’85],  we  relate  the  normal  contact  velocity 
after  collision  to  its  value  before  collision:  JNQ  =  —eJNQ°. 
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The  constraints  on  the  tangential  velocity  component  are  related  to  friction.  If 
|ST|  <  /i|SN|,  where  p  is  the  coefficient  of  friction,  there  will  be  no  sliding  after 
collision.  That  is  =  0  or  JT0  =  0,  and  from  (1)  the  impact  impulse 


becomes 


If  |ST|  =  or  ST  —  ±pSN,  there  will  be  sliding  after  collision,  and  from  (1) 

the  normal  impact  impulse  becomes  instead 

=-(l  +  e)[J/vA/-1JT(:ij/i)]-1Jw0o.  (2.4) 

The  sign  is  determined  from  tin:  -  ndition  ST  vT  =  ST(JTQ)  <  0. 

For  our  study  we  assume  a  perfectly  elastic  collision,  e  =  1,  and  a  frictionless 
contact,  p  —  0.  Then,  the  impact  impulse  has  only  a  normal  component.  These 
assumptions  will  not  affect  our  basic  conclusions,  because  e’s  value  only  affects 
the  magnitude  of  SN ,  while  p  is  almost  always  relatively  small.  (4)  now  becomes 


2^©° 


where  v°N  is  the  normal  component  of  the  approach  velocity  at  the  contact  point. 


7.3  Effect  on  SN  of  the  last  link’s  mass  distribution 

We  consider  the  effect  of  the  mass  distribution  of  the  last  link  on  the  impact 
impulse.  The  result  shows  that  given  the  mass  distribution  and  the  orientation, 
there  exists  an  optimal  pivot  location  which  minimizes  the  impact  impulse;  the 
corresponding  Ss  is  equivalent  to  that  obtained  when  the  link  is  free  from  joint 
constraint. 

To  see  the  influence  of  the  last  link’s  inertia  distribution  on  SN,  we  first  obtain 
the  impact  impulse  on  a  single  planar  link  while  rotating  about  a  fixed  support, 
as  in  Fig.  7.2.  Applying  (2.5)  to  this  configuration  yields 

S„  =  -2mv°N(?-y.  (3.1) 
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s 


Figure  7.2  Configuration  of  the  last  link 

p  is  the  radius  of  gyration  about  its  joint,  and  d  is  the  distance  between  the 
joint  pivot  and  the  line  of  the  contact  normal.  Given  the  mass  and  the  approach 
velocity,  in  order  to  reduce  the  impact  impulse,  we  need  to  reduce  p2/d2;  0,  =  90 
degrees  corresponds  to  maximum  d. 


There  exists  an  optimal  solution  for  pivot  location.  We  assume  that  the  radius 
of  gyration  about  the  mass  center  is  pQ,  the  distance  between  the  mass  center 
and  line  of  action  of  the  contact  normal  is  dQ,  and  that  a  general  pivot  position 
is  characterized  by  variables  r  and  a.  Then, 


5 


N 


(Pl  +  r 2) 

( d0  +  rsina)2 


2 mv°  . 

N 


(3.2) 


From  dSN/da  =  0  and  dSN/dr  =  0,  we  obtain  the  optimal  conditions  a*,r*: 


I  CNI 

II 

• 

6 

(3.3) 

o 

r*  =  — . 

da 

(3.4) 

Substituting  a*,r*  into  (2),  we  obtain  minimum  SN: 


sM  =  - 


- - - - 2 mv°  . 

K  +  pD  N 


(3.5) 


We  can  verify  that  this  is  equivalent  to  the  formula  obtained  when  the  link  is 
free  from  joint  constraint.  In  other  words,  there  will  be  no  reaction  to  the  impact 
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impulse  at  the  joint.  This  is  the  well-known  result  that  if  the  impact  load  is  at 
the  center  of  percussion  there  are  no  pivot  reaction  forces. 

Based  on  this  optimal  pivot  location,  we  can  also  compare  the  effect  of  a  link’s 
geometric  shape  on  SN .  For  example,  for  a  slender  rod  of  length  /  with  uniformly 
distributed  mass  and  perpendicular  contact  at  the  end,  r*  =  // 6  -the  optimal 
pivot  is  at  // 3;  SN  =  —mv°  f 2.  For  a  disk  with  diameter  D  and  uniformly 
distributed  mass,  if  we  assume  dQ  —  D/2,  then  r*  =  Z>/4;  SN  =  -2mti°/3. 

7.4  Mass  proportions  of  links  for  reducing  SN 

Except  in  the  case  when  the  last  joint  is  an  instantaneous  optimal  pivot  for  the 
last  link,  the  supporting  links  affect  the  impact  impulse  on  the  manipulator.  In 
this  section  and  in  sections  6  and  7,  we  consider  the  relationships  between  the 
impact  impulse  and  the  mass  distribution  among  the  links. 


In  this  section  we  analyze  how  to  distribute  mass  among  links  in  order  to  re¬ 
duce  SN.  The  value  of  SN  in  (2.5)  is  a  function  of  mass  distribution  and  link 
orientation,  but  independent  of  each  link’s  length.  We  will  show  that  in  order 
to  reduce  SN,  generally  the  mass  of  the  last  link  should  be  less  than  that  of  its 
supporting  link.  Similarly,  the  mass  of  that  supporting  link  should  be  less  than 
its  own  supporting  link’s.  Although  this  will  also  be  true  for  all  the  rest  of  the 
links,  we  will  show  later  that  the  other  links  have  little  influence  on  SN. 

For  members  with  uniformly  distributed  mass,  [J NM~'i  J//\  is  independent  of 
each  link’s  dimensions.  This  can  be  seen  if  we  express  the  inverse  of  the  inertia 
matrix  in  (1.7)  as 


M-  =  |M|  =  a{[11  =  MEul 


A  and  BtJ  are  coefficients  independent  of  l,.  Then, 
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In  cases  where  links  are  other  than  slender-rods,  we  can  take  /*  =  g,l,,  and  a 
similar  link-length  independence  follows. 

If  we  wish  to  reduce  SN,  the  last  link’s  mass  should  be  less  than  that  of  its 
supporting  link.  For  example  for  a  slender-rod  2-link  chain  of  total  mass  M, 
m,  =  AM,  and  m2  =  (I  —  A)M,  when  the  chain  is  in  a  straight  out  position 


1  A  Mv° 


sin29l 


(4.1) 


Figure  7.3  Influence  on  SN  of  mass  proportions  of  2-  or  3-link  chain 


In  Fig.  7.3(a)  a  plot  of  /2( A)  shows  that  /2(A)  drops  almost  linearly  with  respect 
to  A.  When  A  =  1,  i.e.,  when  the  mass  of  the  last  link  is  negligible,  F2,  hence 
SN ,  becomes  0. 

For  the  same  reason,  the  mass  of  the  link  next  to  the  last  should  also  be  less 
than  that  of  its  supporting  link.  TT.  i  O  V.  ill  UOVt  U  V  v.  jk  \  I  t  li  h  an  example  of  a 

slender-rod  3-link  chain  in  a  straight  out  position.  We  assume  that  the  last  link 
is  of  mass  ms,  the  first  two  links  have  total  mass  M,  m,  =  AM,  m2  =  (1  —  A)M, 


& 
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and  M/m3  =  x.  Then 


c  2.a(l-A)(A  +  3)  +  3  mat;» 

N  3  i(l  —  A)(A  +  3)  +  4  sin70l 


f3{\,x)m3v°N 

sin29l 


In  Fig.  7.3(b)  we  plot  f3(\,x)  as  a  family  of  curves  with  different  fixed  values 
of  x.  From  these  we  notice  that  when  A  =  1,  i.e.,  the  last  link  is  connected  to 
a  massless  link,  SN  has  the  smallest  coefficient  0.5;  when  A  =  0,  i.e.,  the  second 
link  has  all  the  mass  M ,  the  coefficient  of  has  the  largest  value. 

When  links  are  other  than  slender  rods,  the  functions  /2(A)  and  f3{x,  A)  will  have 
different  numerical  values,  but  the  same  tendency  of  change  is  to  be  expected. 

7.5  Dominant  influence  of  last  link  on  SN 

Comparing  Fig.  7.3(a)  and  Fig.  7.3(b),  we  notice  that  /2  drops  faster  than  f3 
as  A  increases;  this  is  because  SN  is  most  sensitive  to  the  mass  of  the  last  link. 
Actually,  SN  is  approximately  proportional  to  the  mass  of  the  last  link,  and 
inversely  proportional  to  the  square  of  the  sine  of  its  orientation  angle. 

The  approximate  proportionality  to  the  last  link’s  mass  can  be  seen  from  the 
expression  for  SN.  For  a  2-link  chain  of  slender  rods, 

_  m,  +  3m2(l  —  3/4cos202)  ,  2m2t>° 

N  im2sin26l/sin29i2  —  3m7cos6'2sin01/sin9l2  +  ml  +  3m2  J  3stn2012 
=  -F2m2  v°s 

(5.1) 

The  SN  for  a  3-link  chain  of  slender  rods  can  be  similarly  expressed  as 

S„  =  -Fsmav°N.  (5.2) 

Both  F2  and  F3  are  dimensionless. 

For  any  link  shape,  we  can  partition  each  moment  of  inertia  /,  in  (1.6)  as  a 
product  of  mass  and  radius  of  gyration.  The  general  expression  for  SN  for  a  2  or 
3-link  chain  will  show,  that  there  is  approximately  an  m„  factor  in  its  numerator. 
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When  the  mass  of  the  last  link,  within  a  slender-rod  linkage,  is  much  less  than 
the  mass  of  the  rest  of  the  links,  the  impact  impulse  at  contact  simply  takes  the 
form 

2mnv° 

<53> 


For  a  general  link  shape,  the  formula  for  the  case  where  the  last  link’s  mass  is 
comparatively  very  small  is  as  shown  in  (3.1).  This  solution  is  equivalent  to  the 
one  for  a  link  attached  to  a  moving  base  with  relatively  huge  inertia. 

As  we  have  seen,  SN  is  approximately  inverse  to  sin!^n  for  a  slender-rod  linkage. 
Regardless  of  0,  for  such  a  2-link  chain,  the  012,  which  minimizes  F2,  is  around 
90  degrees  -the  link  is  parallel  to  the  contact  tangent;  the  012,  which  maximizes 
F2,  is  around  zero  degrees  -the  link  is  parallel  to  the  contact  normal. 

The  angles  0°  and  90°  for  a  slender-rod  linkage  actually  satisfy  the  global  opti¬ 
mization  conditions:  dSN/ddt}  =  0;  j  =  1,2,  •••,«.  For  a  general  shape  of  the 
last  link,  on  which  the  impact  point  is  assumed  invariant,  we  define  the  orienta¬ 
tions  of  the  last  link  which  minimize  SN  and  maximize  SN  to  be  7min  and  ~fmax, 
respectively.  Although  7min  should  be  determined  from  the  global  optimization 
conditions  above,  we  can  specify  its  range  from  the  results  of  Section  3.  When 
the  last  link  is  supported  by  a  fixed  base  we  know  that  0 ,„  =  90°,  and  when  the 
last  link  is  free  from  constraint  we  notice  from  (3.5)  that  da  becomes  a  maximum 
when  a  line  through  the  contact  point  and  mass  center  is  parallel  to  the  contact 
tangent.  From  Fig.  7.1  the  last  link’s  angle  should  be  0,n  =  90  +  rp  -  /3n.  So, 
7 min  is  in  the  range  [90,  90  -1 -  ifr  —  /?„];  ~fmax  =  7 min  —  90.  When  the  mass  center 
is  collinear  with  the  contact  point  and  the  joint,  then  7mt„  =  90,  and  7mai  =  0. 

7.6  Influence  of  other  links  on  SN 

The  influences  of  links  other  than  the  last  one  on  SN  are  afiected  by  the  orienta¬ 
tion  of  the  last  link  and  their  nearness,  in  terms  of  sequence,  to  the  last  link.  It 
turns  out  that  when  the  last  link  gradually  rotates  from  7 maI  (the  link  is  or  nearly 
is  parallel  to  the  contact  normal)  to  7m,n  (the  last  link  is  or  nearly  is  parallel  to 
the  contact  tangent),  the  influence  on  SN  of  the  two  links  immediately  before  the 
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last  decreases,  though  at  the  start  the  influence  is  significant.  It  becomes  very 
small  once  the  last  link  is  nearly  at  jmin.  The  influence  on  SN  decreases  as  one 
moves  backwards  link  by  link  toward  the  fixed  end  of  the  chain. 


When  the  last  link  is  at  7maI,  all  its  mass  is  moving  in  the  impact  direction, 
and  its  supporting  link  now  dominates  any  variation  in  SN.  For  example,  taking 
0i7  =  0  in  (5.1)  yields 


S 


N 


2m,  v° 

■ - —  1  + 

SsirfOi 


3  m2 
rri) 


(6.1) 


We  see  SN  is  now  approximately  proportional  to  and  inversely  proportional 
to  sin2#,.  The  last  link  in  this  case  increases  SN  so  that  when  92  =  90  degrees, 
and  m,/m2  =  1,  the  SN  is  1.75  times  as  large  as  it  would  be  without  the  last 
link. 


Flmin  ^3min 


(a)  {b) 


Figure  7.4  Influence  on  SN  of  the  first  link  of  2-  or  3-link  chain 


While  the  last  link  rotates  away  from  7moi,  the  other  links  still  have  a  relatively 
big  influence  within  a  large  range  of  its  orientation.  Substituting  an  orientation 
for  the  last  link  in  (5.1)  and  (5.2),  there  are  for  9,  two  angles  which  minimize 
and  maximize  SN,  respectively.  Fig.  7.4(a)  shows  a  family  of  curves  of  minimum 
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F2  in  (5.1)  versus  012,  for  different  link-mass  ratios  in  a  2-link  chain  of  slender 
rods.  The  corresponding  curve  family  of  maximum  F2,  however,  all  collapse  to 
one  curve  which  is  the  same  as  when  mt  m2.  Fig.  4(b)  shows  similar  curves  of 
F3  in  (5.2)  versus  0i3  for  a  3-link  chain,  with  the  last  two  links  collinear.  Clearly, 
before  the  last  link  reaches  the  contact  tangential  direction,  there  are  still  big 
differences  between  extreme  values  of  F2  and  F3\  the  two  links  nearest  to  the  last 
link  still  have  a  big  influences.  As  the  last  link’s  angle  approaches  7min,  such 
influence  is  dramatically  reduced.  The  influence  of  the  first  link  of  the  3-link 
chain  is  seen  to  be  negligible,  no  matter  how  much  mass  it  possesses. 

Fig.  4(a)  and  Fig.  7.4(b)  also  show  that  the  influence  on  SN,  of  the  mass  and 
orientation  of  the  first  link  in  a  3-link  chain,  is  much  less  than  in  a  2-link  chain.  As 
the  number  of  links  increase  over  3,  the  additional  proximal  links  have  little  effect 
on  SN.  We  can  see  this  from  a  comparison  of  coefficients  of  SN.  For  example, 
for  r lender-rod  chains  with  equal  mass  at  each  link  in  straight  out  configuration, 
we  have:  for  a  single  link, 

2  mxv°  rrij 

s„  =  =  -°-67^Vf;  (6-2) 

3 stn2#,  sin  0, 


for  a  2-link  chain, 


for  a  3-link  chain, 


7m2y°N  m2v°N 

N  12 sin*6,  ’  sin20, 


26  m3v°  m3v° 

S»  =~4r  -  20  =—0-578—^-. 
45sin2tq  sin'  ul 


The  tendency  of  coefficient  convergence  is  clear:  adding  additional  links  causes 
the  coefficient  to  converge  to  a  value  close  to  0.578,  as  can  be  verified  by  further 
calculations. 


We  point  out  that,  the  influence  of  o*her  links  on  SN  is  lower  bounded  if  we  treat 
the  last  link  as  su  -oorted  on  a  fixed  base,  and  upper  bounded  if  we  treat  the 
last  link  as  free  from  joint  constraint.  For  a  slender-rod  link,  (5.3)  gives  its  lower 
bound;  its  upper  bound  is, 

2  m„v° 

S  = _ _ 

N  3  S!n20ln  +  1' 


^vIl  rtj 
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Such  lower  and  upper  bounds  for  a  general  link  are  obtainable  from  (3.1)  and 
(3.5). 

7.7  Change  of  angular  velocity  and  reaction  impulse  at  joint 


We  have  studied  different  influences  on  the  impact  impulse  at  the  point  of  contact. 
In  this  section  we  show  that  the  change  of  link  angular  velocity,  and  reaction  im¬ 
pulse  at  each  joint  are  proportional  to  the  contact  impact  impulse.  Furthermore, 
the  coefficients  of  their  magnitudes  decrease  link  by  link  as  we  move  toward  the 
base,  if  the  linkage  is  near  a  straight-out  position. 

The  proportionality  to  SN  of  the  change  in  joint  angular  velocity  can  be  seen 
directly  from  (2.1).  The  change  of  link  angular  velocity  is 

0  =  0°  +  A'S„,  (7.1) 

where  K  =  M~l  =  [kl,  k7,  . . . ,  kn\T .  The  corresponding  change  of  joint  rate 
is  9,  =  9°  +  (k,  -  k,+i)S. 

The  diagonal  ( n  —  i)"1  element  of  the  inertia  matrix  is  a  significant  factor  in 
the  denominator  of  the  k,.  Take  a  2-link  chain  composed  of  slender  rods  as  an 
example, 

[j  sing,  -  cos  97  sin  012] 

MC'l1  +  m2 ) j  -  \‘>n7cos767] 

_  m2)sinfl12  -  \m7  cos  07  sing,] 

^  m2l2[(^  +  mz)1- -  '-m7cos302]  ' 

When  m,  >  m2  >  •  •  >  m„,  and  each  mass  difference  is  significant,  k,  is 
approximately  inversely  proportional  to  the  ( n  —  i)tfl  element  of  inertia  matrix. 


and  ky 


(m7/3)t7’ 

-TT-  and  ks 


;  for  a  3-link 


For  a  2-link  chain  of  slender  rods,  k,  ~  ; — 777- — rr  and  k7  ~  — 7 777-;  for  a  3-link 
chain  of  slender  rods,  kt  ~  — 7— - — —  k2  ~  : — 777 — rr-  and  ks  ~  - 

’  1  (m1prra3+m])l1  1  1  (m2/S  +  m3)l2  J  m3l3 

From  the  structure  of  the  inertia  matrix  in  (1.7),  we  can  expect  the  same  to  be 
true  for  an  n-link  chain  of  slender  rods. 

Due  to  the  structure  of  k,,  when  a  chain  of  rods  is  in  a  straight  out  position,  the 
magnitudes  of  k,  decrease  from  the  last  link  to  the  first  link.  When  m,  =  m2  in 


ajfjt 

K 

r>y 
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a  2-link  chain  of  slender  rods, 


6sin0,  _  30  sin  0, 
7m2li  '  "  7 m2l2 


(7.4) 


When  m]  =  m2  =  m3  in  a  3-link  chain  of  slender  rods, 

_  3  sin  _  15  sin  0!  57 sin 0! 

1  13m3 !\  ’  2  13m3/2  ’  5  13 m3l3 

Similarly,  when  all  m,  are  equal  in  an  n-link  chain,  we  can  expect  that  |ib1|  < 
\k2\  <  •  •  •  <  \kn\  and  the  sign  of  li,  changes  alternatively  as  we  go  from  1  to  n  —  1; 
the  sign  of  kn  is  positive. 


The  reaction  impulse  at  each  joint  is  also  proportional  to  the  impact  impulse 
at  the  point  of  contact.  Let  J*  be  the  transformation  matrix  which  relates  the 
velocity  of  the  mass  center  of  the  itfl  link  to  the  manipulator’s  angular  velocity 
vector;  X"  =  J*Q: 

j.  _  ( LcosOx  l2cos9l2  ljCoa(6xj- V  0,)  0  0\ 

‘  \lisin0x  l2sin9l2  ljsin(9lj  +  0j)  0  0/  '  ' 

Let  R,  be  the  reaction  impulse  at  the  ith  joint;  R,  —  [/{tT,  f?,y]r.  Then, 


ft,  =R2  -  m,J'KSN 
R?  =  R a  -  m2J2KSN 
R3  —  Ra  —  m3Js  A  5^ 


This  reduces  to  the  equations  below  for  a  slender-rod  linkage: 


+ 


f lncos9ln 
\lnsin9in 


+  ■■■ 


(7.8) 


( lncos6ln 
\lnsin6 ln 


( l}  cos9Xj 
\  I}sin9l} 

))SN 


) 


+  m(j  +  l  )n^+l 


(  /;  +  i  ros01(_,  +  i )  \ 

\  /;+i  sin9 Kj+i )  / 


(7.9) 
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m*n  =  \irij  -f  rn,+,  +  ■  •  •  +  m„;  m’nk}  is  not  too  sensitive  to  mass  distribution 
since  kj  has  a  comparable  term  in  its  denominator. 

When  a  linkage  is  in  a  straight-out  position,  the  impact  impulse  at  each  joint 
reduces  from  the  last  link  to  the  first  link.  We  can  look  at  a  slender-rod  linkage 
parallel  to  the  contact  tangent.  For  a  2-link  chain 


Rly  =  R‘y  =  Vn*v°N' 


(7.10) 


For  a  3-link  chain 


1  14  „  31 

Riy  =  R2y  =  ~  —  m3v°N,  R3y  =  —m3v°N. 


45  *  45 

Obviously,  all  R,x  =  0  in  this  configuration. 


(7.11) 


7.8  On  the  extension  to  spatial  linkages 

The  above  analysis  helps  us  in  understanding  spatial  motion  as  well.  The  idea  of 
link  space  can  be  directly  applied  to  a  spatial  linkage.  The  normal  impact  impulse 
is  still  given  by  expression  (2.5),  as  long  as  we  keep  the  same  assumptions,  though 
the  Jacobian  matrix  and  the  inertia  matrix  need  to  be  associated  with  spatial 
configurations.  When  the  reference  z  axis  is  not  parallel  to  the  contact  normal, 
n,  the  denominator  in  (2.5)  simply  becomes  [i\TJTM~l  7n]. 

For  spatial  linkages,  the  influences  of  link-mass  distribution  on  the  impact  im¬ 
pulse  are  further  complicated  by  the  orientations  of  the  joint  axes.  If  there  exists 
a  wrist  point  and  it  can  be  modeled  as  a  spherical  joint  (we  assume  the  mo¬ 
ments  of  inertia  of  the  grasped  object  is  dominant  and  the  link  inertias  can  be 
neglected),  the  lower  bound  of  the  influence  of  the  other  links  on  the  impact 
impulse  can  be  obtained  when  we  assume  the  wrist  point  is  fixed: 


S„  = 


2t>° 

N 


(/2rij  —  /jUj)2//,  -f  ( /  j n i  —  (,n3)2 / 12  +  (fiU2  —  /2n))2//3 


(8.1) 


Here,  the  reference  axes  are  parallel  to  the  principal  axes  of  inertia,  /,  are  the 
principal  moments  of  inertia  about  the  wrist  point,  and  n,  arc,  respectively, 
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the  components  of  a  vector  from  the  joint  to  the  contact  point  and  a  unit  vector 
parallel  to  the  contact  normal.  Similarly,  the  upper  bound  can  be  obtained  when 
we  assume  the  object  is  free  from  joint  constraints.  The  expression  is  the  same 
as  (8.1)  except  we  need  to  add  1/M  to  the  denominator  and  all  quantities  are 
now  associated  with  the  mass  center. 

By  the  same  procedure  as  for  planar  linkages,  we  can  obtain  the  optimal  spherical 
joint  location  for  an  end-link  (including  the  grasped  object)  mass.  Let  w  = 
1  x  n.  For  a  general  reference  frame  at  the  mass  center,  the  denominator  of 
(8.1)  becomes  wTM“' w,  where  M0  is  a  matrix  of  moments  of  inertia.  Assigning 
a  position  vector  to  the  wrist  point,  calculating  moments  of  inertia  using  the 
parallel  axis  transfer  theorem,  and  taking  derivatives  with  respect  to  the  wrist 
point  position  vector,  we  can  obtain  the  optimal  joint  location  solution. 

In  a  similar  manner  all  our  analyses  for  planar  chains  can  be  extended  to  spatial 
configurations.  Although  the  techniques  are  essentially  the  same,  the  details  for 
spatial  linkages  are  of  course  much  more  complex  than  for  the  simpler  planar 
devices. 

This  completes  our  study  of  the  influences  of  the  linkage  design  and  configuration 
parameters  on  the  impact  impulse  which  occurs  at  the  beginning  of  a  direct 
contact  motion. 
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CONCLUSIONS 


For  robot  motion  with  environmental  contact,  we  have  studied  the  contact  kine¬ 
matics,  a  model  based  control  formulation  and  extensions  of  the  AL  robot  pro¬ 
gramming  language.  We  have  also  studied  design  rules  for  the  reduction  of  the 
impact  impulse  at  the  onset  of  contact. 

The  contact  kinematics  we  studied  was  for  rigid  bodies  moving  under  planar  mo¬ 
tions  with  point  contacts  (between  curves),  spatial  motions  with  point  contacts 
(between  surfaces)  and  spatial  motions  with  line  contacts  (between  developable 
ruled  surfaces).  For  point  contact,  we  studied  the  instantaneous  contact  point 
fixed  on  the  moving  body  and  its  trajectory,  the  moving  point  trajectory.  W'e 
also  studied  the  moving  and  fixed  contact  trajectories  for  a  pair  of  imaginary 
points  which  do  not  belong  to  either  body,  but  are  always  coincident  with  the  in¬ 
stantaneous  contact  points.  For  line  contact  we  studied  a  moving  reference  point 
on  the  instantaneous  contact  line,  and  the  moving  and  fixed  contact  trajectories 
for  a  pair  of  imaginary  points.  In  each  case  we  have  obtained  the  velocity,  accel¬ 
eration,  and  jerk  for  the  moving  contact  point,  and  the  velocity  and  acceleration 
for  the  pair  of  imaginary  points.  Constraints  on  the  motion  to  maintain  point 
or  line  contacts  have  also  been  obtained.  All  these  are  expressed  as  functions  of 
surface  geometry  and  the  roll-slide  motion  parameters  at  the  contact. 

The  forms  of  these  basic  relationships  for  special  motions  and  special  geometries 
have  also  been  included.  The  special  motions  for  point  contact  are  pure  rolling 
and  pure  sliding;  those  for  line  contact  are  motions  with  no  rotation  about  the 
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contact  line  and  no  sliding  at  the  moving  point.  The  special  geometries  treat 
cases  where  either  moving  or  fixed  surface  is  a  point,  a  line  or  a  plane. 

The  expressions  obtained  for  the  contact  trajectories  are  directly  useful  for  auto¬ 
matic  trajectory  planning  and  actual  motion  sensing.  By  specifying  the  contact 
trajectories,  and  the  moving  bodies  instantaneous  orientation  and  sliding,  the 
moving  point’s  trajectory  is  partially  or  completely  determinable  from  the  ex¬ 
pressions  derived  in  this  thesis.  The  same  relationships  can  also  be  useful  for 
detecting  an  object  motion  from  tactile  sensor  reading,  since  the  contact  trajec¬ 
tories  become  determinable  quantities.  It  has  been  shown  that  when  the  moving 
body  is  undergoing  special  motion,  one  force  or  tactile  sensor  is  sufficient  for 
determining  the  angular  velocity  or  the  sliding  velocity  of  the  moving  body.  We 
have  also  extended  the  expressions  for  a  single  contact  to  analogous  ones  for  two 
or  three  contacts;  from  these  we  can  determine  a  moving  body's  general  roll-slide 
motion. 

The  analytical  expressions  are  also  useful  for  estimating  a  moving  object’s  posi¬ 
tion  from  touch  sensor  information.  For  point  contact  between  two  planar  curves, 
the  reading  of  the  tactile  sensor  can  be  used  to  locate  the  contact  point  on  the 
moving  curve.  The  constraint  that  the  rotation  angle  of  the  moving  body  is  the 
sum  of  the  angles  turned  through  by  the  two  contact  normals  (measured  with 
respect  to  the  corresponding  curves)  provides  a  useful  guide  to  locate  the  con¬ 
tact  position  on  the  moving  body.  For  spatial  point  contact,  we  introduce  an 
approximate  integration  to  determine  the  position  of  the  point  of  contact. 

The  derived  relationships  governing  the  instantaneous  properties  of  the  moving 
point’s  trajectory  can  be  used  for  both  position  and  force  control.  We  have 
extended  the  operational  space  control  formulation  so  that  the  controller  error 
equations  are  decoupled  in  task  coordinates.  This  new  formulation  is  valid  even 
when  the  contact  point  varies  with  respect  to  the  moving  surface  or  there  are 
multiple  contacts.  The  control  variables  can  be  directly  associated  with  contact 
constraints,  and  force  control  in  these  directions  will  not  affect  the  decoupling  of 
the  motion-error  equations  as  long  as  friction  is  negligible. 
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In  designing  a  motion  compatibility  filter,  we  include  the  normal  acceleration  in 
the  control  law  and  simply  set  the  stiffness  coefficients  corresponding  to  the  force 
control  directions  to  zeroes.  For  a  spatial  manipulator  we  also  derived  a  first  order 
motion  compatibility  filter  using  the  contact  normals.  The  dynamics  parameters 
for  task  coordinate  formulations  can  be  simply  calculated  from  those  for  the 
usual  operational  space.  When  there  are  only  orientation  differences  between  a 
task  frame  and  an  operational  reference  frame,  the  control  in  “operational  space” 
and  in  task  space  are  equivalent.  The  model-based  control  can  be  extended  to 
grasping,  where  both  the  moving  body  and  the  supporting  fingers  need  to  be 
considered  as  a  single  system. 

It  is  useful  for  a  control  formulation  to  be  specified  in  a  high-level  language. 
We  have  extended  the  AL  robot  language  to  incorporate  direct  contact.  We 
let  AL  accept  information  about  the  moving  surface’s  geometry,  and  provide 
means  to  generate  general  position-interpolation  trajectories,  general  orientation- 
interpolation  trajectories  (particularly  when  a  reference  line  of  an  object  is  spec¬ 
ified),  and  certain  function  and  run-time  condition  monitored  trajectories.  We 
have  also  discussed  the  kinematic  and  force  conditions  for  determining  the  posi¬ 
tional  and  rotational  task  frames,  and  introduced  ways  to  specify  position-error 
tolerances,  directional  wobbles  and  several  other  practically  useful  motion  char¬ 
acteristics. 

In  considering  <  le  instant  of  making  contact,  we  have  analyzed  the  sensitivity 
of  impact  impulse  to  the  mass  distribution  of  a  planar  manipulator.  We  have 
shown  that  for  a  revolute-joint  planar  manipulator,  the  Jacobian  and  inertia 
matrix  can  be  simplified  if  they  are  expressed  in  link-space  coordinates.  For 
the  last  link  there  exists  an  optimal  location  of  the  joint  pivot.  We  have  also 
shown  that:  11  The  mass  should  decrease  link  by  link  as  one  moves  toward 
to  the  end-effector,  in  order  to  reduce  the  impact  impulse.  2)  The  last  link 
dominates  the  impact  impulse.  3)  Its  neighboring  links’  masses  and  orientations 
have  a  big  influence  when  the  last  link  is  not  nearly  parallel  to  the  contact 
tangent.  4)  The  change  of  the  angular  velocity  and  reaction  impulse  at  a  joint 
are  proportional  to  the  impact  impulse  at  the  point  of  contact.  The  results  of 
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this  analysis  imply  that  it  is  worthwhile  to  consider  light-weight  end-efFectors 
and  micro-manipulator  attachments  in  order  to  reduce  the  impacts  associated 
with  environmental  contacts. 

In  this  work  we  have  given  an  extensive  development  of  the  instantaneous  kine¬ 
matics  of  direct  contact.  This  is  the  heart  of  this  dissertation,  and  has  received 
most  of  our  attention.  The  control  system  and  AL  language  extensions  have  been 
less  developed  in  this  work,  and  these  are  the  areas  that  could  profit  most  from 
further  study  and  extensions.  In  order  to  broaden  the  practical  implementations 
of  the  developed  theory,  it  would  be  useful  to  have  a  corresponding  AL  run-time 
system  connected  to  the  AL  language  system  through  message  passing.  Finally, 
the  results  of  this  thesis  should  be  implemented  with  a  hardware  system  consist¬ 
ing  of  a  force  controlled  manipulator,  and  a  a  gripper  with  a  pair  of  force  fingers 
capable  of  sensing  all  six  force  components. 


Appendix  A  -  Curvatures  of  the  Contacting  Curves 

It  is  well  known  from  elementary  calculus  that  for  a  planar  curve,  given  in  the 
explicit  form  y  =  h(x),  the  curvature  can  be  expressed  as 


k  =  - r  i  /i  1 1 

(1 +  /»?)* 

At  the  zero  position,  using  equations  (2.2.3)  (equation  2.3  of  Chapter  2)  we  have 

km  =  /lm,2t  kj  =  hj2  (A2) 

The  derivative  of  the  curvature  with  respect  to  the  arc  length  can  be  obtained 
using  the  chain  rule,  dk/ds  =  (dk/dx)(dx/ds).  From  (Al)  dk/dx  =  /i3(  1  + 
/i,  )"$  —  S/ij/i,  (1  +  /t,  )~2  and  as  is  well  known  dx/ds  =  (1  +  /*,)_^-  Substituting 
into  the  dk/dx  expression  for  the  initial  position  from  equations  (2.2.3)  yields 
dkm/dx  =  hm3  and  dkj/dx  —  hf  3.  Similarly  from  the  dx/ds  expression  we 
obtain  =  1  and  dxjds f  =  1.  Substituting  into  the  chain  rule  we  have 

*- = £  =  "■■■■•■  ^  <-43) 

where  sm  and  sr  are  the  arc  length  variables  with  respect  to  the  moving  and  the 
fixed  curves  respectively. 

Higher  order  derivatives  of  the  curvature  can  be  derived  in  a  similar  manner. 
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Appendix  B  —  Compound  Planar  Motion  at  a  Point  of  Contact 


curve  m 


0,  curve  f 


Figure  B.l  Two  moving  curves 

When  both  contacting  bodies  are  in  motion,  we  introduce  a  third  frame  S  ,  which 
is  stationary  (see  Figure  B.l).  There  is  now  a  motion  of  body  f,  defined  by  the 
Of  frame,  with  respect  to  the  5  frame,  and  a  motion  of  the  body  m,  with  frame 
Om  ,  with  respect  to  both  body  /  and  frame  S. 

We  define  cu,  c,  v,  a  to  be,  respectively,  the  angular  velocity,  angular  acceleration, 
and  the  contact  point’s  velocity  and  acceleration,  for  the  motion  of  body  m 
relative  to  / ;  and  u>m,  cm,  vm,  am  to  be  the  same  variables  for  the  motion  of  body 
m  with  respect  to  5,  while  ,  rf ,  v/ ,  a^  are  the  variables  for  the  motion  of  body 
f  with  respect  to  5.  The  linear  velocities  and  accelerations  defined  here  are  for 
the  points  coincident  at  P,  the  first  two  cases  deal  with  P„,  and  the  third  case  is 
for  point  P}. 

For  body  m  the  angular  velocity  and  acceleration  satisfy  the  simple  linear  super¬ 


positions. 


—  uf  +  u>,  cm  —  ( f  -f  f 


Similarly  for  point  Pm  on  body  m  we  have  vm  =  v  +  v.  The  contact  condition 
requires  that  in  the  direction  of  the  contact  tangent,  t, 

vm  t  =  v  -t  +  v-t  (B2) 


•«l 
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and  in  the  direction  of  the  contact  normal  n 

vm  n  =  v/  n  (£3) 

Similarly  for  the  acceleration  of  point  Prn  on  body  m,  we  have  am  =  af  +  a  + 
2u>  x  v  and  in  the  tangential  direction  this  yields 

am  t  =  a,  t  +  a  t  {BA) 


while  the  normal  component  must  be 


am  •  n  =  a/  n  +  2u>f  vx  +  a  •  n 


where  a  •  n  is  the  same  as  in  (2.2.12)  or  (2.2.13),  except  that  the  velocities  and 
angular  velocities  are  replaced  by  their  respective  relative  velocities. 


Appendix  C  -  Derivatives  of  h(x,  y)  from  a  General  Surface  Representation 

A  general  analytic  expression  for  a  surface  can  be  in  either  the  form  r(u,  v)  (u  and 
v  are  two  parameters)  or  F( X,  Y,  Z)  —  0.  Here  r  is  a  position  vector  and  F  is  a 
scalar  function,  they  are  associated  with  a  frame  which  has  an  arbitrary  point  as 
the  origin  and  three  arbitrary  perpendicular  lines  as  the  X,  Y  and  Z  coordinate 
axes.  We  first  assume  the  r(u,  v)  expression.  Let  r(u0,u0)  denote  the  position 
vector  to  the  point  of  contact.  We  define  a  new  reference  frame  which  has  its 
origin  at  the  point  ol  contact,  and  its  z  axis  parallel  to  the  inwardly  directed 
surface  normal  *  (z  =  h(x,y),  the  *  and  y  axes  are  in  the  tangent  plane  ).  We 
denote  i,  j,  k  as  three  unit  vectors  parallel  to  the  x,  y  and  z  axes  respectively,  x ,  y 
and  h  satisfy  the  relations 


x  =  [r(u,  t>)  -  r(u0,v0)J  i 

V  =  [r(u,v)  —  r(uOI  t’0)j  j 

h  =  [r(u,  v)  -  r(u0,w0)]  •  k 


(Cl) 

(C2) 

(C3) 


From  (Cl)  and  (C2),  if  the  surface  is  continuous  and  differentiable  at  the  point 
of  contact,  and  the  x-y  pair  has  one  to  one  correspondence  to  the  u-v  pair,  there 
exist  the  inverse  relations 


u  —  u(x,  y),  v  =  v(x,  y) 


(04) 


To  show  how  to  determine  the  partial  derivatives  of  h,  we  take  an  example.  The 
partial  derivative  of  h  with  respect  to  x  is  (from  (C3)), 


fx  ~  [r„ur  +  r„ux]  •  k 


(CS) 


To  obtain  uz,vx  we  take  the  partial  derivative  with  respect  to  x  of  (Cl)  and 
(C2): 


1  =  (r„u*  +  r„wx)  •  i,  0  =  (r„ux  +  r„ux)  •  j 


(O  6) 


For  the  outwardly  directed  normal,  instead  of  h  we  use  —h,  and  every  step  in 
the  following  remains  unaltered. 
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From  this  we  can  obtain  ux,vx, 

ux  =  rv  •  j[ru  •  ir„  •  j  —  ru  •  jr*  •  i]-1 ,  =  -ru  j[ru  ir„  j  -  ru  jr„  i]_I  {Cl) 

The  partial  derivatives  of  h  with  respect  to  x  and  y  up  to  an  arbitrary  order 
can  be  obtained  from  (C3).  The  partial  derivatives  of  u  and  v  with  respect  to 
either  x  or  y  can  be  obtained  by  taking  the  partial  derivatives  simultaneously 
over  equations  (Cl)  and  (C2),  and  then  inverting  the  resulting  equations. 

When  a  surface  is  of  the  form  F{X ,  Y,  Z )  =  0,  by  the  rule  of  implicit  partial 
derivatives,  if  we  regard  Z  as  a  function  of  x  and  y: 


zx  =  ---,  Zy=—±  [C  8) 

*  Z  *  Z 

If  we  define  u  —  X  and  v  —  Y,  although  we  do  not  have  the  explicit  expression 
r(w,  v ),  we  can  obtain  all  its  partial  derivatives  from  (C8).  We  notice  in  the 
foregoing  context,  the  partial  derivatives  of  h  are  related  to  only  the  partial 
derivatives  of  r(u,  v).  So  from  a  general  analytic  expression  for  a  surface,  we  can 
in  general  obtain  the  partial  derivatives  of  h{x,  y). 


Appendix  D  -  Curvature  Expressions  from  h(x,y ) 


It  is  well  known  that  the  curvature  of  a  curve  which  is  on  the  surface  ;  =  /i(x,  y) 
and  in  a  plane  parallel  to  the  x-z  plane  is 

'  (1+/^ 

If  instead  the  curve  is  in  a  plane  parallel  to  the  y-z  plane  the  curvature  is 

i,  __  ^  yy 

y~  (i  +h*)i 

Substituting  (3.1.3)  for  the  initial  position, 

kx  =  h.x ,  ky  =  hyy  (£>1) 


Taking  the  partial  derivatives  of  the  above  curvatures,  and  substituting  (3.1.3) 
for  the  initial  position,  we  have 


lc  —  h 


U-xXy, 


h  —  h 

'VJ/X  "  I  yy< 


Jl-  =  h, 


{in) 


To  measure  the  parallelism  of  tangents  of  a  family  of  curves  which  are  either  in 
planes  parallel  to  the  x-z  plane  or  > n  planes  parallel  to  the  y-z  plane,  we  only 
need  to  observe  one  component  (since  it  is  a  unit  vector).  The  s  component  of 
a  tangent  of  a  curve  parallel  to  the  x-z  plane  and  th  y  component  of  a  tangent 
of  a  curve  parallel  to  y-z  plane  ar~  respectively. 


<x 


U  ,  _ 

v/T+7 r  '  yr+7; 


The  partial  derivative  of  tx  with  respect  to  y  (o'  the  partial  derivative  of /v  with 
respect  to  r)  at  the  initial  position  is 


9  : 


/ 


*  V 


U)  3) 
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Appendix  E  -  Compound  Spatial  Motion  at  a  Point  of  Contact 


Assuming  there  are  three  frames,  S,  m  and  /,  attached  to  a  fixed  space,  a  moving 
body  and  a  finger  respectively.  We  denote  Qm,  £m,  Vm  and  am  to  be  respectively 
the  angular  velocity,  angular  acceleration,  and  the  velocity  and  acceleration  of 
the  point  of  contact  for  the  motion  of  the  moving  body  relative  to  S.  We  denote 
Q Vf  and  as  the  same  variables  for  the  motion  of  the  finger  relative  to  S, 
and  Q.  £,  V  and  a  to  be  the  variables  for  the  motion  of  the  moving  body  relative 
to  /.  For  the  angular  velocity,  it  is  well  known  that  Qm  —  Qf  +  f2,  or 

utA  /*>\ 

W/t2  I  +  I  U>2  I  (•£’1) 

"/.a/  \"a/ 

For  the  angular  acceleration  £m  =  £j  +  £  +  Qj  x  U,  in  matrix  form 

Cf  ,1  \  /  tl  \  /  u /, 2^3  ~~  UJ,  ,3^2  \ 

2  ]  I  u,/.s<*h  1  (£2) 

,  3  /  \<3  /  / 


The  velocity  of  the  point  of  contact  is  Vm  =  V}  +  V,  or 


(«Vi 

I'm,! 

Vm,3 


(EZ) 


For  acceleration  of  the  point  of  contact,  it  is  also  well  known  that  am  =  ay  -f 
a/  +  2 Qf  x  V,  in  matrix  form 


( 


ft  m,  1 

am,  2 
^  m,3 


) 


a 


/■> 


,2 

.3 


+ 


”^2^,  .3 

+  2  |  j 

'■2W,  ,1  —  t?!  5 


(£4) 
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Appendix  F  -  Finding  an  Orthogonal  Curve  on  a  Ruled  Surface 


In  this  appendix  we  prove  that  we  can  always  find  curves  r,  which  are  normal  to 
the  directions  L,. 

A  developable  ruled  surface  can  be  described  by 

R  =  r  +  dL,  (FI) 

where  r  is  an  arbitrary  curve  on  the  surface.  We  can  always  obtain  a  curve  r 
which  passes  through  a  given  reference  point  d  and  is  perpendicular  to  the  cor¬ 
responding  L.  Using  a  superscript  prime  to  denote  each  derivative  with  respect 
to  an  arbitrary  parameter  u,  we  have, 

R'  —  r'  +  d'l  +  dl R"  =  r"  +  d"L  +  2 d'l'  +  dl".  (F2) 

By  varying  d  we  can  let  the  locus  of  R  be  the  required  curve  r.  To  first  order,  the 
orthogonality  condition  requires  that  R'L  =  0,  from  which  we  obtain  d'  =  —r'l. 
To  second  order  the  orthogonality  condition  requires  that  R"  L  +  R'  L'  —  0, 
so  we  obtain  d"  =  -R'L'  -  a" L'  -  dL"  ■  L.  In  this  way  we  can  construct  R ,  R' 
and  R"  to  be  respectively  the  position  vector  and  the  first  two  derivatives  of  our 
desired  curve  r.  In  order  to  obtain  the  derivatives  with  respect  to  the  arc-length 
of  r,  we  have  the  relations, 

dR'_dR'du_  (PR  _  </2/?  du  2  dJl<Pu^ 
ds  du  ds  ’  ds2  du 2  ds  du  ds 

where  du/ds  =  \/(R'  ■  T),  and  <Pu/ds 2  =  -(<FR/du2)(du/ds)s.  Thus  we  have 
justified  our  statement. 
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